CN111352422A - Unmanned vehicle line patrol method and system based on self-learning radio frequency tag and unmanned vehicle - Google Patents

Unmanned vehicle line patrol method and system based on self-learning radio frequency tag and unmanned vehicle Download PDF

Info

Publication number
CN111352422A
CN111352422A CN202010150030.6A CN202010150030A CN111352422A CN 111352422 A CN111352422 A CN 111352422A CN 202010150030 A CN202010150030 A CN 202010150030A CN 111352422 A CN111352422 A CN 111352422A
Authority
CN
China
Prior art keywords
unmanned vehicle
detection antenna
radio frequency
antenna
tag
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
CN202010150030.6A
Other languages
Chinese (zh)
Other versions
CN111352422B (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.)
Shaanxi Leishen Intelligent Equipment Co ltd
Original Assignee
Shaanxi Leishen Intelligent Equipment Co ltd
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 Shaanxi Leishen Intelligent Equipment Co ltd filed Critical Shaanxi Leishen Intelligent Equipment Co ltd
Priority to CN202010150030.6A priority Critical patent/CN111352422B/en
Publication of CN111352422A publication Critical patent/CN111352422A/en
Application granted granted Critical
Publication of CN111352422B publication Critical patent/CN111352422B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/028Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/10Internal combustion engine [ICE] based vehicles
    • Y02T10/40Engine management systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention relates to the technical field of automatic navigation, in particular to a self-learning radio frequency tag-based unmanned vehicle line patrol method, a self-learning radio frequency tag-based unmanned vehicle line patrol system and an unmanned vehicle, wherein the line patrol method comprises the following steps: the method comprises the steps that a plurality of radio frequency tags with unique numbers are arranged on a route to be patrolled, route information on the route to be patrolled is obtained through a self-learning method, the radio frequency tags and the numbers thereof in front of an unmanned vehicle are detected in real time through a plurality of detection antennas arranged at the front end of the unmanned vehicle, and a target tag to be passed on and behind the route is confirmed according to the arrangement sequence of the radio frequency tags; and confirming the current advancing direction according to the signal strength between the plurality of detection antennas and the target tag, and controlling the unmanned vehicle to pass through the target tag along the advancing direction so as to finish line patrol. The method adopts the radio frequency tag with small volume, easy arrangement and low cost, simultaneously adopts the radio frequency tag detection technology, is not limited by light or GPS signal intensity, and can be applied to various environments.

Description

Unmanned vehicle line patrol method and system based on self-learning radio frequency tag and unmanned vehicle
Technical Field
The invention relates to the technical field of automatic navigation, in particular to an unmanned vehicle line patrol method and system based on self-learning radio frequency tags and an unmanned vehicle.
Background
In order to save manpower, the automatic navigation robot is generally applied in industry at present, in the existing automatic navigation or line patrol technology, a two-dimensional code recognition technology is partially adopted, if light is dark, recognition errors can be caused or time is spent, and the navigation precision and the line patrol speed are influenced. And part of the technologies adopt three-dimensional modeling and GPS positioning, if a GPS signal in a workshop is weak, the positioning precision and the navigation precision are influenced, and meanwhile, a GPS positioning module is required by adopting the GPS positioning technology, so that the hardware cost is increased. Therefore, the existing unmanned vehicle line patrol technology is easily limited by application environment conditions, and the automatic line patrol technology cannot be realized in partial application environments.
Disclosure of Invention
In order to solve the technical problem that the unmanned vehicle line patrol technology in the prior art cannot be applied to partial environments, the application provides an unmanned vehicle line patrol method and system based on a self-learning radio frequency tag and an unmanned vehicle.
An unmanned vehicle line patrol method based on a self-learning radio frequency tag comprises the following steps:
arranging a plurality of radio frequency tags with unique numbers on a path to be patrolled;
controlling the unmanned vehicle to travel for a circle along the route to be patrolled and acquiring route information on the route to be patrolled by a self-learning method in the traveling process; the path information at least comprises the number of each radio frequency tag on the path to be patrolled and the arrangement sequence of the radio frequency tags;
detecting radio frequency tags and serial numbers thereof in front of the unmanned vehicle in real time through a plurality of detection antennas arranged at the front end of the unmanned vehicle, and confirming a target tag to be passed by the next upper path according to the arrangement sequence of the radio frequency tags;
confirming the current traveling direction according to the signal strength between the plurality of detection antennas and the target tag;
controlling the unmanned vehicle to pass the target tag along the direction of travel.
In another embodiment, the unmanned vehicle comprises a first detection antenna and a second detection antenna which are arranged at the front end of the vehicle body side by side;
the confirming a current traveling direction according to the signal strength between the plurality of detection antennas and a target tag, the controlling the unmanned vehicle to pass through the target tag along the traveling direction comprising:
respectively acquiring signal strengths between the first detection antenna and the target radio frequency tag and between the second detection antenna and the target radio frequency tag, judging whether the signal strengths corresponding to the first detection antenna and the second detection antenna are equal, if so, determining that the direction opposite to the unmanned vehicle is the advancing direction, and controlling the unmanned vehicle to linearly advance along the advancing direction and pass through the target radio frequency tag;
if not, determining the direction of one side of the first detection antenna and the second detection antenna, where the antenna with the smaller corresponding signal strength is located, as a fine adjustment direction, controlling the unmanned vehicle to adjust the direction of the vehicle head towards the fine adjustment direction when the unmanned vehicle travels until the signal strengths corresponding to the first detection antenna and the second detection antenna are equal, then taking the direction opposite to the unmanned vehicle as the traveling direction, and controlling the unmanned vehicle to travel linearly along the traveling direction and pass through the target tag.
In another embodiment, the unmanned vehicle further comprises a third detection antenna arranged at the front end of the vehicle body side by side, and the first detection antenna, the second detection antenna and the third detection antenna are sequentially arranged at the front end of the vehicle body at equal intervals;
the confirming a current traveling direction according to the signal strength between the plurality of detection antennas and a target tag, the controlling the unmanned vehicle to pass through the target tag along the traveling direction comprising:
respectively acquiring signal strength between a first detection antenna, a second detection antenna, a third detection antenna and the target tag, judging whether the signal strength corresponding to the second detection antenna is minimum and the signal strength corresponding to the first detection antenna and the third detection antenna is equal, if so, taking the direction corresponding to the second detection antenna as the advancing direction, and controlling the unmanned vehicle to linearly advance along the advancing direction and pass through the target tag;
if not, determining the direction of one side of the three antennas where the corresponding antenna with the maximum signal intensity is located as a fine adjustment direction, controlling the unmanned vehicle to adjust the direction of the vehicle head towards the fine adjustment direction when the unmanned vehicle travels until the signal intensity corresponding to the second detection antenna is minimum and the signal intensities corresponding to the first detection antenna and the third detection antenna are equal, then taking the direction of the second detection antenna as the traveling direction and controlling the unmanned vehicle to travel linearly along the traveling direction and pass through the target tag.
In another embodiment, the unmanned vehicle further comprises a fourth detection antenna and a fifth detection antenna which are arranged at the rear end of the vehicle body;
the automatic line patrol method for the unmanned vehicle further comprises the following steps: when the unmanned vehicle is controlled to linearly advance along the advancing direction, the radio frequency tag positioned behind the vehicle body is detected through the fourth detection antenna and the fifth detection antenna, the signal strength between the fourth detection antenna and the radio frequency tag positioned behind the vehicle body is respectively obtained, whether the signal strength corresponding to the fourth detection antenna is equal to that corresponding to the fifth detection antenna is judged, and if the signal strength is equal to that corresponding to the fifth detection antenna, the advancing speed of the unmanned vehicle is increased according to a preset speed regulation method.
In another embodiment, the controlling the unmanned vehicle to adjust the direction of the vehicle head toward the fine adjustment direction while traveling includes:
respectively acquiring distances between the first detection antenna and the target label and between the second detection antenna and the target label according to the signal strength between the first detection antenna and the target label;
calculating the angle to be steered of the unmanned vehicle according to the distance between the first detection antenna and the target tag, the distance between the second detection antenna and the target tag, and the distance between the first detection antenna and the second detection antenna;
controlling the unmanned vehicle to move, and meanwhile, adjusting the opposite direction of the head of the unmanned vehicle towards the fine adjustment direction according to a preset adjustment speed;
wherein, according to preset adjustment speed to fine setting direction adjustment unmanned vehicle locomotive just to the direction includes:
angle adjustment: adjusting the preset adjustment angle in each time towards the fine adjustment direction according to a preset adjustment speed, re-obtaining the signal strength between the first detection antenna and the target label and the signal strength between the second detection antenna and the target label after each adjustment is completed, judging whether the signal strength corresponding to the first detection antenna is equal to that corresponding to the second detection antenna, and stopping adjusting the direction of the vehicle head if the signal strength is equal to that corresponding to the first detection antenna;
if not, re-confirming the angle to be steered, repeating the angle adjusting step until the signal strength corresponding to the first detection antenna and the second detection antenna is equal;
the preset adjusting angle is one half or one third of the angle to be steered;
the angle to be steered is obtained by calculating the following formula:
Figure BDA0002402117580000041
wherein b represents the angle to be steered, L1Indicating the distance, L, between the first probe antenna and the target tag2Indicating the distance, L, between the second probe antenna and the target tag3Representing the distance between the first and second probe antennas.
In another embodiment, the method further comprises:
acquiring adjustment information of the direction of the head between every two adjacent tags and distance information between every two adjacent tags by a self-learning method in the process of the unmanned vehicle traveling; the path information also comprises adjustment information of the direction of the vehicle head between every two adjacent tags and distance information between every two adjacent tags;
and planning a path track of the path to be patrolled according to the path information.
In another embodiment, the unmanned vehicle further comprises a sixth detection antenna arranged at the bottom of the vehicle body;
the automatic unmanned vehicle line patrol method further comprises the following steps: and detecting whether the unmanned vehicle is located above a certain radio frequency tag currently or not through the sixth detection antenna in the process of the unmanned vehicle traveling, if so, simultaneously acquiring the number of the radio frequency tag, and predicting the current position of the unmanned vehicle on the path track according to the number of the radio frequency tag.
An unmanned vehicle line patrol system based on self-learning radio frequency tags is characterized in that a plurality of radio frequency tags with unique numbers are arranged on a path to be patrolled; the system comprises:
the self-learning module is used for acquiring path information on the path to be patrolled by a self-learning method; the path information at least comprises the number of each radio frequency tag on the path to be patrolled and the arrangement sequence of the radio frequency tags;
the system comprises a plurality of detection antennas, a radio frequency identification device and a wireless communication device, wherein the detection antennas are arranged at the front end of an unmanned vehicle so as to detect the radio frequency identification and the serial number thereof in front of the unmanned vehicle in real time in the process of the unmanned vehicle;
the traveling direction planning module is used for confirming a target label to be passed by the next target label on the path according to the arrangement sequence of the radio frequency labels and confirming the current traveling direction according to the signal strength between the plurality of detection antennas and the target label;
and the motion control module is used for controlling the unmanned vehicle to pass through the target label along the advancing direction.
In another embodiment, the unmanned vehicle comprises a first detection antenna and a second detection antenna which are arranged at the front end of the vehicle body side by side;
the advancing direction planning module is used for respectively acquiring the signal strength between the first detection antenna and the target radio frequency tag and the signal strength between the second detection antenna and the target radio frequency tag, judging whether the signal strength corresponding to the first detection antenna is equal to that corresponding to the second detection antenna, if so, determining that the direction opposite to the unmanned vehicle is the advancing direction, and controlling the unmanned vehicle to linearly advance along the advancing direction and pass through the target radio frequency tag;
if not, determining the direction of one side of the first detection antenna and the second detection antenna, where the antenna with the smaller corresponding signal strength is located, as a fine adjustment direction, controlling the unmanned vehicle to adjust the direction of the vehicle head towards the fine adjustment direction when the unmanned vehicle travels until the signal strengths corresponding to the first detection antenna and the second detection antenna are equal, then taking the direction opposite to the unmanned vehicle as the traveling direction, and controlling the unmanned vehicle to travel linearly along the traveling direction and pass through the target tag.
In another embodiment, the unmanned vehicle further comprises a fourth detection antenna and a fifth detection antenna which are arranged at the rear end of the vehicle body;
the motion control module is further used for detecting the radio frequency tag located behind the vehicle body through the fourth detection antenna and the fifth detection antenna when the unmanned vehicle linearly advances along the advancing direction, respectively acquiring the signal strength between the fourth detection antenna and the radio frequency tag located behind the vehicle body, judging whether the signal strength corresponding to the fourth detection antenna is equal to that corresponding to the fifth detection antenna, and if so, improving the advancing speed of the unmanned vehicle according to a preset speed regulation method.
In another embodiment, the controlling the unmanned vehicle to adjust the direction of the vehicle head toward the fine adjustment direction while traveling includes:
and controlling the unmanned vehicle to move, and adjusting the direction opposite to the head of the unmanned vehicle according to a preset adjusting speed and the fine adjustment method.
In another embodiment, the self-learning module is further used for acquiring adjustment information of the direction of the head between every two adjacent tags and distance information between every two adjacent tags by a self-learning method in the process of the unmanned vehicle traveling; the path information also comprises adjustment information of the direction of the vehicle head between every two adjacent tags and distance information between every two adjacent tags;
the automatic line patrol system of the unmanned vehicle further comprises a path planning module used for planning the path track of the line to be patrolled according to the path information.
In another embodiment, the unmanned vehicle further comprises a sixth detection antenna arranged at the bottom of the vehicle body;
the automatic unmanned vehicle line patrol system further comprises a positioning module, wherein the positioning module is used for detecting whether the unmanned vehicle is located above a certain radio frequency tag currently or not through the sixth detection antenna in the process of the unmanned vehicle traveling, and if so, the number of the radio frequency tag is obtained at the same time, and the current position of the unmanned vehicle on the path track is predicted according to the number of the radio frequency tag.
An unmanned vehicle based on self-learning radio frequency tag line patrol comprises the unmanned vehicle line patrol system.
According to the unmanned vehicle line patrol method based on the self-learning radio frequency tags, a plurality of radio frequency tags with unique numbers are arranged on a path to be patrolled, the unmanned vehicle is controlled to travel for a circle along the path to be patrolled, and path information on the path to be patrolled is acquired through the self-learning method in the travel process; the path information at least comprises the number of each radio frequency tag on the path to be patrolled and the arrangement sequence of the radio frequency tags. Detecting a radio frequency tag and the serial number thereof in front of the unmanned vehicle in real time through a plurality of detection antennas arranged at the front end of the unmanned vehicle; confirming a target label to be passed by the next path according to the arrangement sequence of the radio frequency labels, and confirming the current advancing direction according to the signal strength between the plurality of detection antennas and the target label; and controlling the unmanned vehicle to pass through the target label along the advancing direction so as to finish line patrol. The method adopts the radio frequency tag with small volume, easy arrangement and low cost, simultaneously adopts the radio frequency tag detection technology, is not limited by light or GPS signal intensity, and can be applied to various environments. In addition, labels with different densities can be arranged when the unmanned vehicle straightly moves and turns, so that the requirement of accurately controlling the position precision of the unmanned vehicle is met, and the unmanned vehicle can turn accurately.
Drawings
Fig. 1 is a flowchart of an automatic unmanned vehicle line patrol method according to an embodiment of the present application;
FIG. 2 is a schematic diagram of a probe tag arrangement according to an embodiment of the present application;
FIG. 3 is a front view of an unmanned vehicle and probe antenna according to an embodiment of the present application;
FIG. 4 is a top view of an unmanned vehicle and probe antenna according to an embodiment of the present application;
FIG. 5a is a schematic diagram of signal strength between a detecting antenna and a plurality of front tags according to an embodiment of the present application;
fig. 5b is a schematic diagram of signal strength when the direction of the head of the straight line section is opposite to the radio frequency tag according to the embodiment of the present application;
FIG. 6 is a schematic diagram of signal strength when the direction of the head of the vehicle is not aligned with the target tag at a curve;
FIG. 7 is a schematic diagram of signal strength under the condition that the direction of the head of the vehicle is adjusted and is right opposite to a target label in a curve;
FIG. 8 is a schematic diagram of signal strength under the condition that the vehicle head direction can be adjusted and the target tag can be accelerated at the same time when the vehicle head direction is aligned;
FIG. 9 is a schematic view of an angle to be adjusted in the direction of the vehicle head;
FIG. 10 is a schematic view of the detection range of the detection antenna at the bottom of the vehicle body;
fig. 11 is a schematic structural view of the automatic line patrol system of the unmanned vehicle according to the embodiment;
fig. 12 is a schematic diagram of signal strength before and after adjustment of the vehicle head of the unmanned vehicle according to the embodiment.
Detailed Description
The present invention will be described in further detail with reference to the following detailed description and accompanying drawings. Wherein like elements in different embodiments are numbered with like associated elements. In the following description, numerous details are set forth in order to provide a better understanding of the present application. However, those skilled in the art will readily recognize that some of the features may be omitted or replaced with other elements, materials, methods in different instances. In some instances, certain operations related to the present application have not been shown or described in detail in order to avoid obscuring the core of the present application from excessive description, and it is not necessary for those skilled in the art to describe these operations in detail, so that they may be fully understood from the description in the specification and the general knowledge in the art.
Furthermore, the features, operations, or characteristics described in the specification may be combined in any suitable manner to form various embodiments. Also, the various steps or actions in the method descriptions may be transposed or transposed in order, as will be apparent to one of ordinary skill in the art. Thus, the various sequences in the specification and drawings are for the purpose of describing certain embodiments only and are not intended to imply a required sequence unless otherwise indicated where such sequence must be followed.
The numbering of the components as such, e.g., "first", "second", etc., is used herein only to distinguish the objects as described, and does not have any sequential or technical meaning. The term "connected" and "coupled" when used in this application, unless otherwise indicated, includes both direct and indirect connections (couplings).
The first embodiment is as follows:
referring to fig. 1, the present embodiment provides a method for unmanned vehicle line patrol based on self-learning radio frequency tags, including:
step 101: arranging a plurality of radio frequency tags with unique numbers on a path to be patrolled;
step 102: controlling the unmanned vehicle to travel for a circle along the path to be patrolled and acquiring path information on the path to be patrolled by a self-learning method in the traveling process; the path information at least comprises the number of each radio frequency tag on the path to be patrolled and the arrangement sequence of the radio frequency tags;
step 103: detecting a radio frequency tag and the serial number thereof in front of the unmanned vehicle in real time through a plurality of detection antennas arranged at the front end of the unmanned vehicle;
step 104: confirming a target label to be passed by the next path according to the arrangement sequence of the radio frequency labels, and confirming the current advancing direction according to the signal strength between the plurality of detection antennas and the target label;
step 105: controlling the unmanned vehicle to pass through the target tag along the advancing direction; and thus, the radio frequency tags sequentially pass through all the tags according to the arrangement sequence of the radio frequency tags to finish line patrol.
When the radio frequency tags are arranged in step 101, as shown in fig. 2, the radio frequency tags are arranged along a path to be patrolled, wherein the arrangement of straight line segments is sparse, and the arrangement of the radio frequency tags of turning nodes is dense, so that the unmanned vehicle can be controlled to accurately travel along a path track. The radio frequency tag, particularly the passive UHF tag, has the characteristics of small volume, low cost and easy layout, so that the intelligent line patrol unmanned vehicle based on the radio frequency tag key node has great application value.
In step 102, firstly, an unmanned vehicle is controlled by a manual remote control technology to travel for a circle along a path to be patrolled, and path information on the path to be patrolled is acquired by a self-learning method in the traveling process; the route information includes the number of each radio frequency tag on the route to be patrolled and the arrangement sequence of the radio frequency tags, the unique number of each radio frequency tag can be used as the identity information, for example, the number of a certain tag is obtained as number 5, the arrangement sequence of the radio frequency tags is the number arrangement sequence of tags which are sequentially passed by the unmanned vehicle on the route to be patrolled, for example, the number arrangement sequence of the tags is number 2-3-4. And storing the number of each radio frequency tag and the number arrangement sequence of the tags.
In step 103, during normal line patrol, the radio frequency tags in front of the unmanned vehicle on the route can be detected in real time by the multiple detection antennas arranged at the front end of the unmanned vehicle, and numbers of the radio frequency tags are acquired at the same time, so that two tags in front can be detected generally, and the number of the next tag on the route can be determined according to the acquired tag number arrangement sequence. In other embodiments, the radio frequency tag that is to pass through next to the next path may also be determined according to the signal strength between the radio frequency tag and the detecting antenna, because the distance between the radio frequency tag that is to pass through next and the detecting antenna is generally relatively short, the signal strength between the radio frequency tag and the detecting antenna is relatively high, and thus the radio frequency tag that is to pass through next may be determined, and the tag that is to pass through next is taken as the target tag.
Generally, the signal strength between the detecting antenna and the rf tag is larger, which indicates that the distance between the detecting antenna and the rf tag is closer, for example, in fig. 5a, if both the first detecting antenna 31 and the second detecting antenna 32 detect the rf tag n, the rf tag (n +1), and the rf tag (n +2), which are abbreviated as tag n, tag (n +1), and tag (n +2) in the figure. The signal strength between the first detecting antenna 31 and the second detecting antenna 32 and the tag n, the tag (n +1), and the tag (n +2) are respectively obtained, and since the distance between the second detecting antenna 32 and the tag n is the shortest and the signal strength is the greatest, the direction of the second detecting antenna 32 is closer to the radio frequency tag n, and therefore the tag with the number n is the next target tag to be passed through.
In step 104, by obtaining the signal strength between the multiple detecting antennas and the target tag, the direction corresponding to the detecting antenna with the highest signal strength between the general detecting antenna and the target tag is relatively close to the current traveling direction.
Specifically, as shown in fig. 3 and 4, the unmanned vehicle in the present embodiment includes a first detection antenna 31 and a second detection antenna 32 which are arranged side by side at the front end of the vehicle body 3, the detection antennas in this example are antennas designed according to the reflection principle, and the detection range thereof is related to the direction and the installation position of the antennas, for example, the first detection antenna 31 and the second detection antenna 32 are installed at the front end of the vehicle body, and the detection direction thereof is as shown by two broken lines in fig. 5 b. The method comprises the steps of detecting a radio frequency tag on a path in front of an unmanned vehicle through a first detection antenna 31 and a second detection antenna 32 which are arranged at the front end of the unmanned vehicle, obtaining the serial number A of the radio frequency tag, and respectively obtaining the signal strength between the first detection antenna 31 and the radio frequency tag A and the signal strength between the second detection antenna 32 and the radio frequency tag A, judging whether the signal strengths corresponding to the first detection antenna 31 and the second detection antenna 32 are equal, if so, determining that the direction over against the current head of the unmanned vehicle is the advancing direction, and controlling the unmanned vehicle to linearly advance along the advancing direction and pass through a target tag A. As shown in fig. 6, if the signal intensities corresponding to the first detecting antenna 31 and the second detecting antenna 32 are not equal, it is indicated that the direction opposite to the vehicle head is not the correct vehicle traveling direction, the direction of the side of the first detecting antenna 31 and the second detecting antenna 32 where the corresponding antenna with the smaller signal intensity is located is determined as the fine adjustment direction, as shown by the arrow in fig. 6, the direction of the vehicle head is adjusted toward the fine adjustment direction when the unmanned vehicle travels, as shown in fig. 7, until the signal intensities corresponding to the first detecting antenna 31 and the second detecting antenna 32 are equal, the direction opposite to the vehicle head is determined as the traveling direction, and the unmanned vehicle is controlled to travel along the traveling direction to pass through the target tag a. According to the method, the line patrol is completed by sequentially passing through all the radio frequency tags on the path to be patrolled.
In another embodiment, the unmanned vehicle further comprises a third detection antenna arranged at the front end of the vehicle body side by side, the first detection antenna, the second detection antenna and the third detection antenna are sequentially arranged at the front end of the vehicle body at equal intervals, namely the second detection antenna is arranged in the middle, and the first detection antenna and the third detection antenna are respectively arranged at two sides of the second detection antenna. Respectively acquiring signal strength between a first detection antenna, a second detection antenna, a third detection antenna and a target label, judging whether the signal strength corresponding to the second detection antenna is minimum and the signal strength corresponding to the first detection antenna and the third detection antenna is equal, if so, taking the direction corresponding to the second detection antenna as a traveling direction, and controlling the unmanned vehicle to linearly travel along the traveling direction and pass through the target label; if not, determining the direction of one side of the three antennas where the corresponding antenna with the maximum signal intensity is located as a fine adjustment direction, controlling the unmanned vehicle to adjust the direction of the vehicle head towards the fine adjustment direction when the unmanned vehicle is moving, and controlling the unmanned vehicle to move linearly along the moving direction and pass through the target tag after the signal intensity corresponding to the second detection antenna is minimum and the signal intensities corresponding to the first detection antenna and the third detection antenna are equal.
In this embodiment, when the head of the unmanned vehicle is adjusted after the fine adjustment direction of the unmanned vehicle is confirmed, the unmanned vehicle is controlled to move and the direction opposite to the head of the unmanned vehicle is adjusted by the fine adjustment method according to a preset adjustment speed. As in the state of fig. 6 to the state of fig. 7, when the unmanned vehicle is adjusted to the direction opposite to the vehicle head, the unmanned vehicle is adjusted while traveling, for example, when the direction opposite to the vehicle head of the unmanned vehicle is adjusted at an angular velocity of 10 ° per second during traveling, and whether the signal intensities corresponding to the first detection antenna 31 and the second detection antenna 31 are the same or not needs to be detected in real time during adjustment, the adjustment is stopped, and the direction opposite to the vehicle head of the current unmanned vehicle is taken as the traveling direction, so that the unmanned vehicle is controlled to travel along the traveling direction.
In this embodiment, controlling the unmanned vehicle to adjust the direction of the vehicle head toward the fine adjustment direction when the unmanned vehicle travels includes:
respectively acquiring distances between the first detection antenna and the target label and between the second detection antenna and the target label according to the signal strength between the first detection antenna and the target label;
calculating the angle to be steered of the unmanned vehicle according to the distance between the first detection antenna and the target tag, the distance between the second detection antenna and the target tag, and the distance between the first detection antenna and the second detection antenna;
controlling the unmanned vehicle to move, and adjusting the opposite direction of the head of the unmanned vehicle towards the fine adjustment direction according to a preset adjustment speed;
wherein, according to the adjustment speed of presetting towards the dead direction of fine setting direction adjustment unmanned vehicle locomotive include:
angle adjustment: and adjusting the preset adjusting angle in the fine adjustment direction at each time according to a preset adjusting speed, re-obtaining the signal strength between the first detecting antenna and the target label and the signal strength between the second detecting antenna and the target label after the adjustment is finished at each time, judging whether the signal strength corresponding to the first detecting antenna is equal to that corresponding to the second detecting antenna, and stopping adjusting the direction of the vehicle head if the signal strength is equal to that corresponding to the second detecting antenna.
If not, the angle to be steered is confirmed again, and the angle adjusting step is repeated until the signal strength corresponding to the first detection antenna and the signal strength corresponding to the second detection antenna are equal.
The preset adjusting angle is one half or one third of the angle to be steered;
the steering angle is obtained by calculating the following formula:
Figure DA00024021175839597
wherein b represents the angle to be steered, L1Indicating the distance, L, between the first probe antenna and the target tag2Indicating the distance, L, between the second probe antenna and the target tag3Representing the distance between the first and second probe antennas.
As shown in fig. 9, the installed distance DE between the first detecting antenna 31 and the second detecting antenna 31 can be known from measurement, and the distances AD and AE can be known from the signal strengths between the first detecting antenna 31 and the second detecting antenna 31 and the target tag a, respectively, which are calibrated in advance by measurement, and the distance between each detecting antenna and the antenna can be known from the signal strength of each detecting antenna after receiving the tag according to the relationship between the signal strength and the distance. b is the angle of the head to be steered, the angles of a and d can be known according to the distance between AD, AE and DE, as shown in FIG. 12, when the head is adjusted to the position right facing the target tag A, the distance between the first detecting antenna 31, the second detecting antenna 31 and the target tag A forms an isosceles triangle, the angle of c is further calculated, that is, the angle b to be steered is obtained, the control system can control the steering angle of the unmanned vehicle in the advancing process, and the direction adjustment is completed.
When the steering angle is adjusted, the adjustment amount each time is one half of the angle to be steered, for example, the angle to be steered of the vehicle head is b, the adjustment amount of the vehicle head during the first steering is 1/2b, then whether the adjustment requirement is met is judged according to the method, that is, whether the signal intensities corresponding to the first detection antenna 31 and the second detection antenna 31 are the same is judged, if the signal intensities are the same, the adjustment requirement is met, the adjustment is stopped, otherwise, the adjustment is continued, the adjustment amount for the second time is 1/4b, and so on until the adjustment requirement is met. It should be noted that, in other embodiments, each adjustment amount may be one third or one fourth of the angle to be steered, such as 1/3b or 1/4b, which is not limited herein.
In the embodiment, the angle to be steered is calculated as b by the following formula:
Figure BDA0002402117580000121
wherein L is1Indicates the distance between the first detecting antenna and the target tag, e.g., the distance between two points AD in FIGS. 9 and 12, L2Indicates the distance between the second probe antenna and the target tag, e.g., the distance between two points AE in FIGS. 9 and 12, L3Which represents the distance between the first probe antenna and the second probe antenna, such as the distance between two points DE in fig. 9 and 12.
In this embodiment, controlling the unmanned vehicle to adjust the direction of the vehicle head toward the fine adjustment direction when the unmanned vehicle travels includes:
respectively acquiring distances between the first detection antenna and the target label and between the second detection antenna and the target label according to the signal strength between the first detection antenna and the target label;
calculating the angle to be steered of the unmanned vehicle according to the distance between the first detection antenna and the target tag, the distance between the second detection antenna and the target tag, and the distance between the first detection antenna and the second detection antenna;
controlling the unmanned vehicle to move, and adjusting the opposite direction of the head of the unmanned vehicle towards the fine adjustment direction according to a preset adjustment speed;
wherein, according to the adjustment speed of presetting towards the dead direction of fine setting direction adjustment unmanned vehicle locomotive include:
angle adjustment: and adjusting the preset adjusting angle in the fine adjustment direction at each time according to a preset adjusting speed, re-obtaining the signal strength between the first detecting antenna and the target label and the signal strength between the second detecting antenna and the target label after the adjustment is finished at each time, judging whether the signal strength corresponding to the first detecting antenna is equal to that corresponding to the second detecting antenna, and stopping adjusting the direction of the vehicle head if the signal strength is equal to that corresponding to the second detecting antenna.
If not, the angle to be steered is confirmed again, and the angle adjusting step is repeated until the signal strength corresponding to the first detection antenna and the signal strength corresponding to the second detection antenna are equal.
The preset adjusting angle is one half or one third of the angle to be steered;
the steering angle is obtained by calculating the following formula:
Figure BDA0002402117580000131
wherein b represents the angle to be steered, L1Indicating the distance, L, between the first probe antenna and the target tag2Indicating the distance, L, between the second probe antenna and the target tag3Representing the distance between the first and second probe antennas.
As shown in fig. 9, the installed distance DE between the first detecting antenna 31 and the second detecting antenna 31 can be known from measurement, and the distances AD and AE can be known from the signal strengths between the first detecting antenna 31 and the second detecting antenna 31 and the target tag a, respectively, which are calibrated in advance by measurement, and the distance between each detecting antenna and the antenna can be known from the signal strength of each detecting antenna after receiving the tag according to the relationship between the signal strength and the distance. b is the angle of the head to be steered, the angles of a and d can be known according to the distance between AD, AE and DE, as shown in FIG. 12, when the head is adjusted to the position right facing the target tag A, the distance between the first detecting antenna 31, the second detecting antenna 31 and the target tag A forms an isosceles triangle, the angle of c is further calculated, that is, the angle b to be steered is obtained, the control system can control the steering angle of the unmanned vehicle in the advancing process, and the direction adjustment is completed.
When the steering angle is adjusted, the adjustment amount each time is one half of the angle to be steered, for example, the angle to be steered of the vehicle head is b, the adjustment amount of the vehicle head during the first steering is 1/2b, then whether the adjustment requirement is met is judged according to the method, that is, whether the signal intensities corresponding to the first detection antenna 31 and the second detection antenna 31 are the same is judged, if the signal intensities are the same, the adjustment requirement is met, the adjustment is stopped, otherwise, the adjustment is continued, the adjustment amount for the second time is 1/4b, and so on until the adjustment requirement is met. It should be noted that, in other embodiments, each adjustment amount may be one third or one fourth of the angle to be steered, such as 1/3b or 1/4b, which is not limited herein.
In the embodiment, the angle to be steered is calculated as b by the following formula:
Figure BDA0002402117580000132
wherein L is1Indicates the distance between the first detecting antenna and the target tag, e.g., the distance between two points AD in FIGS. 9 and 12, L2Indicates the distance between the second probe antenna and the target tag, e.g., the distance between two points AE in FIGS. 9 and 12, L3Which represents the distance between the first probe antenna and the second probe antenna, such as the distance between two points DE in fig. 9 and 12.
Further, as shown in fig. 8, the unmanned vehicle further includes a fourth detection antenna 34 and a fifth detection antenna 35 which are arranged at the rear end of the vehicle body, and the fourth detection antenna 34 and the fifth detection antenna 35 detect the target tag C which is directly facing the front of the current unmanned vehicle after confirming the traveling direction of the unmanned vehicle, and when the unmanned vehicle is controlled to travel linearly along the traveling direction after confirming the traveling direction of the unmanned vehicle, the fourth detection antenna 34 and the fifth detection antenna 35 detect the radio frequency tag B which is located at the rear of the vehicle body at the same time, and respectively acquire the signal strength between the fourth detection antenna 34 and the radio frequency tag B which is located at the rear of the vehicle body and the signal strength between the fifth detection antenna 35 and the radio frequency tag B which is located at the rear of the vehicle body, and determine whether the signal strengths corresponding to the fourth detection antenna 34 and the fifth detection antenna 35 are equal, and if so as to increase the traveling. For example, the vehicle is adjusted to a preset traveling speed, or accelerated according to a preset acceleration strategy, so that the unmanned vehicle is accelerated to travel, and the line patrol efficiency is improved.
In one embodiment, adjustment information of the direction of the head between every two adjacent tags and distance information between every two adjacent tags are obtained through a self-learning method in the traveling process of the unmanned vehicle, the adjustment information of the direction of the head between every two adjacent tags is an angle to be steered between the two tags, the adjustment information can be obtained through a gyroscope sensor on the unmanned vehicle, the distance information between every two adjacent tags can be obtained through an encoder arranged on a motor, and the encoder records the distance of the traveling time period between the two tags. The self-learning path information comprises the serial number of each radio frequency tag, the arrangement sequence of the radio frequency tags, adjustment information of the direction of the head between every two adjacent tags and distance information between every two adjacent tags, a path track of a path to be patrolled is planned according to the path information by a path automatic planning method, the path track is stored, and meanwhile, the path track is continuously updated and corrected through self-learning in the process of going each time, so that the path track is more accurate.
Further, the unmanned vehicle of this embodiment further includes a sixth detection antenna 33 disposed at the bottom of the vehicle body, and detects whether the unmanned vehicle is currently located above a certain electronic tag through the sixth detection antenna 33 in the traveling process of the unmanned vehicle, and if so, obtains the number of the electronic tag at the same time, and predicts the current position of the unmanned vehicle on the path track according to the number of the electronic tag. The sixth detection antenna 33 is disposed at the middle position of the bottom of the vehicle body, and has a relatively small detection range, which is a local area below the vehicle body. When the sixth detecting antenna 33 detects a certain tag, the current position of the unmanned vehicle on the path track can be predicted according to the number of the tag, and the current position of the unmanned vehicle on the current route to be patrolled, that is, the current position of the unmanned vehicle in the current environment, can also be known according to the position.
The multiple detection antennas in this embodiment are all reflection antennas, and the antenna performance is different according to the needs, and the specifically selected antenna sizes (including the size and the power size) are different, for example, the first detection antenna 31 and the second detection antenna 32 arranged in front of the unmanned vehicle are four-arm spiral circular polarization antennas of 75X75 mm 4dBi, and the four-arm spiral circular polarization antennas are general far-field antennas suitable for UHF-band RFID applications, and have the characteristics of small volume, high gain, low standing wave, good pattern symmetry, low axial ratio, and the like. The method can be conveniently applied to UHF frequency band RFID terminals. The frequency range is 902 MHz-928 MHz, and the gain is more than 4 dBi. The fourth detecting antenna 34 and the fifth detecting antenna 35 which are arranged at the rear of the unmanned vehicle adopt 3dBi40X40 mm ceramic antennas, and the ceramic antennas comprise a reflecting plate and ceramic arranged on the reflecting plate, wherein the size of the reflecting plate is 50X50X1 mm, the size of the ceramic is 40X40X4 mm, and the frequency range is 920-925 MHz. The sixth detection antenna 33 disposed at the bottom of the unmanned vehicle employs a 5dBi 25X25 mm ceramic antenna, which also includes a reflection plate having a size of 30X1 mm and a ceramic having a size of 25X4 mm and having a frequency range of 920-925MHz disposed on the reflection plate. Since the sixth detection antenna 33 disposed at the bottom of the unmanned vehicle needs to detect a small range, the size of the reflecting plate and the size of the ceramic are smaller than those of the fourth detection antenna 34 and the fifth detection antenna 35.
The unmanned vehicle automatic line patrol method of the embodiment adopts the radio frequency tag which is small in size, easy to arrange and low in cost, and simultaneously adopts the radio frequency tag detection technology, is not limited by light or GPS signal intensity, and can be applied to various environments.
Example two:
in the embodiment, a plurality of radio frequency tags with unique numbers are arranged on a path to be patrolled, wherein straight line sections are sparsely arranged, and radio frequency tags of turning nodes are densely arranged, so that the unmanned vehicle can be controlled to accurately travel along a path track. A plurality of detection antennas for detecting the radio frequency tags are arranged on the body of the unmanned vehicle or other robots.
Referring to fig. 11, the present embodiment provides a self-learning rf tag-based unmanned vehicle patrol system, which includes a plurality of detecting antennas 201, a self-learning module 202, a traveling direction planning module 203, and a motion control module 204.
The motion control module 204 has a general function of an existing automatic navigation unmanned vehicle, for example, receives a control signal of a wireless remote controller to drive, and in this embodiment, the unmanned vehicle is first controlled by the wireless remote controller to drive for a circle along a route to be patrolled, on which a radio frequency tag is laid.
The self-learning module 202 is configured to obtain path information on the route to be patrolled by a self-learning method in a driving process, where the path information includes the number of each radio frequency tag on the route to be patrolled and the arrangement sequence of the radio frequency tags, and mainly detects tag signals on the route through a plurality of detection antennas 201 arranged on the unmanned vehicle, so as to identify the unique number of the route, and record the number sequence of tags passing through the route.
The plurality of detection antennas 201 are arranged at the front end of the unmanned vehicle, so that the radio frequency tags and the serial numbers thereof in front of the unmanned vehicle can be detected in real time in the process of the unmanned vehicle.
The traveling direction planning module 203 is configured to determine a next target tag to be passed through according to the arrangement sequence of the radio frequency tags, and determine a current traveling direction according to the signal strength between the multiple detection antennas and the target tag.
The motion control module 204 is used for controlling the unmanned vehicle to pass through the target tags along the traveling direction, so that all tags on the path are sequentially passed through according to the number sequence of the tags acquired by the self-learning module 202, and one-time line patrol is completed.
As shown in fig. 4, in this embodiment, the unmanned vehicle includes a first detecting antenna 31 and a second detecting antenna 32 that are arranged at the front end of the vehicle body side by side, the traveling direction planning module 203 is configured to obtain signal strengths between the first detecting antenna 31 and the target radio frequency tag and between the second detecting antenna 32 and the target radio frequency tag, determine whether the signal strengths corresponding to the first detecting antenna 31 and the second detecting antenna 32 are equal, determine that a direction in which the unmanned vehicle is currently aligned is the traveling direction if the signal strengths are equal, and control the unmanned vehicle to travel along the traveling direction and pass through the target radio frequency tag. If not, determining that the direction of one side of the first detection antenna 31 and the second detection antenna 32, where the corresponding antenna with the smaller signal strength is located, is used as a fine adjustment direction, controlling the unmanned vehicle to adjust the direction of the vehicle head towards the fine adjustment direction when the unmanned vehicle is moving until the signal strengths corresponding to the first detection antenna 31 and the second detection antenna 32 are equal, then using the direction opposite to the unmanned vehicle as a moving direction, and controlling the unmanned vehicle to move linearly along the moving direction to pass through the target tag. The specific travel direction confirmation method is the same as that in embodiment 1, and is not described here again.
In another embodiment, the unmanned vehicle further comprises a third detection antenna arranged at the front end of the vehicle body side by side, the first detection antenna, the second detection antenna and the third detection antenna are sequentially arranged at the front end of the vehicle body at equal intervals, namely the second detection antenna is arranged in the middle, and the first detection antenna and the third detection antenna are respectively arranged at two sides of the second detection antenna. Respectively acquiring signal strength between a first detection antenna, a second detection antenna, a third detection antenna and a target label, judging whether the signal strength corresponding to the second detection antenna is minimum and the signal strength corresponding to the first detection antenna and the third detection antenna is equal, if so, taking the direction corresponding to the second detection antenna as a traveling direction, and controlling the unmanned vehicle to linearly travel along the traveling direction and pass through the target label; if not, determining the direction of one side of the three antennas where the corresponding antenna with the maximum signal intensity is located as a fine adjustment direction, controlling the unmanned vehicle to adjust the direction of the vehicle head towards the fine adjustment direction when the unmanned vehicle is moving, and controlling the unmanned vehicle to move linearly along the moving direction and pass through the target tag after the signal intensity corresponding to the second detection antenna is minimum and the signal intensities corresponding to the first detection antenna and the third detection antenna are equal.
Further, as shown in fig. 8, the unmanned vehicle further includes a fourth detecting antenna 34 and a fifth detecting antenna 35 disposed at the rear end of the vehicle body, and the detecting range of the fourth detecting antenna 34 and the detecting range of the fifth detecting antenna 35 are the range of the rear end of the vehicle body, and are the same as the detecting range of the first detecting antenna 31 and the detecting range of the second detecting antenna 32, and are a sector area, so that a tag in front cannot be detected. After the target tag C is confirmed that the head of the current unmanned vehicle is just opposite to the front target tag C, after the advancing direction of the unmanned vehicle is confirmed, when the motion control module 204 controls the unmanned vehicle to linearly advance along the advancing direction, the radio frequency tag B located behind the vehicle body is detected through the fourth detection antenna 34 and the fifth detection antenna 35 at the same time, the signal intensity between the fourth detection antenna 34 and the radio frequency tag B located behind the vehicle body is obtained respectively, whether the signal intensity corresponding to the fourth detection antenna 34 is equal to that corresponding to the fifth detection antenna 35 is judged, and if the signal intensity is equal, the advancing speed of the unmanned vehicle is increased according to a preset speed regulation method. For example, the vehicle is adjusted to a preset traveling speed, or accelerated according to a preset acceleration strategy, so that the unmanned vehicle is accelerated to travel, and the line patrol efficiency is improved.
Wherein, control unmanned car when marcing to fine setting direction adjustment locomotive direction include: and controlling the unmanned vehicle to move, and meanwhile, adjusting the opposite direction of the head of the unmanned vehicle according to a preset adjusting speed towards the fine adjustment method.
The self-learning module 202 is further configured to obtain adjustment information of a locomotive direction between every two adjacent tags and distance information between every two adjacent tags through a self-learning method in the process of the unmanned vehicle traveling; the path information also comprises adjustment information of the direction of the vehicle head between every two adjacent labels and distance information between every two adjacent labels.
The automatic unmanned vehicle line patrol system of the embodiment further includes a path planning module 205, configured to plan a path trajectory of a path to be patrolled according to the path information, and store the path trajectory, meanwhile, the self-learning module 202 continuously learns and corrects the path information in each traveling process, and the path planning module 205 is further configured to continuously correct the path trajectory according to the learned new path information.
Further, the unmanned vehicle of the present embodiment further includes a sixth detection antenna 33 provided at the bottom of the vehicle body. The automatic unmanned vehicle line patrol system of this embodiment further includes a positioning module 206, configured to detect whether the unmanned vehicle is currently located above a certain radio frequency tag through the sixth detection antenna 33 during the traveling process of the unmanned vehicle, and if so, obtain the number of the radio frequency tag at the same time, and predict the current position of the unmanned vehicle on the path track according to the number of the radio frequency tag.
The specific implementation method of each module in this embodiment is the same as that in embodiment 1, and is not described herein again, and meanwhile, the mechanical structures of the unmanned vehicle in this embodiment, such as a steering system, an operation system, and the like, are the same as those of an existing unmanned vehicle or an automatic navigation vehicle, and are not described herein again.
The automatic line system that patrols of unmanned aerial vehicle that this embodiment provided adopts radio frequency label detection technique, does not receive the restriction of light or GPS signal intensity, can use under multiple environment, and surveys accurately, and the navigation accuracy is high.
EXAMPLE III
The embodiment provides an unmanned vehicle based on self-learning radio frequency tag line patrol, and the unmanned vehicle comprises the automatic line patrol system of the unmanned vehicle, which is provided by the embodiment 2.
The present invention has been described in terms of specific examples, which are provided to aid understanding of the invention and are not intended to be limiting. For a person skilled in the art to which the invention pertains, several simple deductions, modifications or substitutions may be made according to the idea of the invention.

Claims (14)

1. An unmanned vehicle line patrol method based on a self-learning radio frequency tag is characterized by comprising the following steps:
arranging a plurality of radio frequency tags with unique numbers on a path to be patrolled;
controlling the unmanned vehicle to travel for a circle along the route to be patrolled and acquiring route information on the route to be patrolled by a self-learning method in the traveling process; the path information at least comprises the number of each radio frequency tag on the path to be patrolled and the arrangement sequence of the radio frequency tags;
detecting radio frequency tags and serial numbers thereof in front of the unmanned vehicle in real time through a plurality of detection antennas arranged at the front end of the unmanned vehicle, and confirming a target tag to be passed by the next upper path according to the arrangement sequence of the radio frequency tags;
confirming the current traveling direction according to the signal strength between the plurality of detection antennas and the target tag;
controlling the unmanned vehicle to pass the target tag along the direction of travel.
2. The automatic unmanned vehicle line patrol method based on the self-learning radio frequency tag as claimed in claim 1, wherein the unmanned vehicle comprises a first detection antenna and a second detection antenna which are arranged side by side at the front end of a vehicle body;
the confirming a current traveling direction according to the signal strength between the plurality of detection antennas and a target tag, the controlling the unmanned vehicle to pass through the target tag along the traveling direction comprising:
respectively acquiring signal strengths between the first detection antenna and the target radio frequency tag and between the second detection antenna and the target radio frequency tag, judging whether the signal strengths corresponding to the first detection antenna and the second detection antenna are equal, if so, determining that the direction opposite to the unmanned vehicle is the advancing direction, and controlling the unmanned vehicle to linearly advance along the advancing direction and pass through the target radio frequency tag;
if not, determining the direction of one side of the first detection antenna and the second detection antenna, where the antenna with the smaller corresponding signal strength is located, as a fine adjustment direction, controlling the unmanned vehicle to adjust the direction of the vehicle head towards the fine adjustment direction when the unmanned vehicle travels until the signal strengths corresponding to the first detection antenna and the second detection antenna are equal, then taking the direction opposite to the unmanned vehicle as the traveling direction, and controlling the unmanned vehicle to travel linearly along the traveling direction and pass through the target tag.
3. The unmanned vehicle automatic line patrol method based on the self-learning radio frequency tag as claimed in claim 2, wherein the unmanned vehicle further comprises a third detection antenna arranged side by side at the front end of the vehicle body, and the first detection antenna, the second detection antenna and the third detection antenna are sequentially arranged at the front end of the vehicle body at equal intervals;
the confirming a current traveling direction according to the signal strength between the plurality of detection antennas and a target tag, the controlling the unmanned vehicle to pass through the target tag along the traveling direction comprising:
respectively acquiring signal strength between a first detection antenna, a second detection antenna, a third detection antenna and the target tag, judging whether the signal strength corresponding to the second detection antenna is minimum and the signal strength corresponding to the first detection antenna and the third detection antenna is equal, if so, taking the direction corresponding to the second detection antenna as the advancing direction, and controlling the unmanned vehicle to linearly advance along the advancing direction and pass through the target tag;
if not, determining the direction of one side of the three antennas where the corresponding antenna with the maximum signal intensity is located as a fine adjustment direction, controlling the unmanned vehicle to adjust the direction of the vehicle head towards the fine adjustment direction when the unmanned vehicle travels until the signal intensity corresponding to the second detection antenna is minimum and the signal intensities corresponding to the first detection antenna and the third detection antenna are equal, then taking the direction of the second detection antenna as the traveling direction and controlling the unmanned vehicle to travel linearly along the traveling direction and pass through the target tag.
4. The unmanned vehicle automatic line patrol method based on the self-learning radio frequency tag as claimed in claim 2 or 3, wherein the unmanned vehicle further comprises a fourth detection antenna and a fifth detection antenna which are arranged at the rear end of the vehicle body;
the automatic line patrol method for the unmanned vehicle further comprises the following steps: when the unmanned vehicle is controlled to linearly advance along the advancing direction, the radio frequency tag positioned behind the vehicle body is detected through the fourth detection antenna and the fifth detection antenna, the signal strength between the fourth detection antenna and the radio frequency tag positioned behind the vehicle body is respectively obtained, whether the signal strength corresponding to the fourth detection antenna is equal to that corresponding to the fifth detection antenna is judged, and if the signal strength is equal to that corresponding to the fifth detection antenna, the advancing speed of the unmanned vehicle is increased according to a preset speed regulation method.
5. The self-learning radio frequency tag-based automatic unmanned vehicle line patrol method according to claim 2, wherein the controlling the unmanned vehicle to adjust a vehicle head direction toward the fine adjustment direction while traveling comprises:
respectively acquiring distances between the first detection antenna and the target label and between the second detection antenna and the target label according to the signal strength between the first detection antenna and the target label;
calculating the angle to be steered of the unmanned vehicle according to the distance between the first detection antenna and the target tag, the distance between the second detection antenna and the target tag, and the distance between the first detection antenna and the second detection antenna;
controlling the unmanned vehicle to move, and meanwhile, adjusting the opposite direction of the head of the unmanned vehicle towards the fine adjustment direction according to a preset adjustment speed;
wherein, according to preset adjustment speed to fine setting direction adjustment unmanned vehicle locomotive just to the direction includes:
angle adjustment: adjusting the preset adjustment angle in each time towards the fine adjustment direction according to a preset adjustment speed, re-obtaining the signal strength between the first detection antenna and the target label and the signal strength between the second detection antenna and the target label after each adjustment is completed, judging whether the signal strength corresponding to the first detection antenna is equal to that corresponding to the second detection antenna, and stopping adjusting the direction of the vehicle head if the signal strength is equal to that corresponding to the first detection antenna;
if not, re-confirming the angle to be steered, repeating the angle adjusting step until the signal strength corresponding to the first detection antenna and the second detection antenna is equal;
the preset adjusting angle is one half or one third of the angle to be steered;
the angle to be steered is obtained by calculating the following formula:
Figure FDA0002402117570000031
wherein b represents the angle to be steered, L1Indicating the distance, L, between the first probe antenna and the target tag2Indicating the distance, L, between the second probe antenna and the target tag3Representing the distance between the first and second probe antennas.
6. The self-learning radio frequency tag-based automatic unmanned vehicle line patrol method according to claim 5, further comprising:
acquiring adjustment information of the direction of the head between every two adjacent tags and distance information between every two adjacent tags by a self-learning method in the process of the unmanned vehicle traveling; the path information also comprises adjustment information of the direction of the vehicle head between every two adjacent tags and distance information between every two adjacent tags;
and planning a path track of the path to be patrolled according to the path information.
7. The automatic unmanned vehicle line patrol method based on the self-learning radio frequency tag as claimed in claim 6, wherein the unmanned vehicle further comprises a sixth detection antenna arranged at the bottom of the vehicle body;
the automatic unmanned vehicle line patrol method further comprises the following steps: and detecting whether the unmanned vehicle is located above a certain radio frequency tag currently or not through the sixth detection antenna in the process of the unmanned vehicle traveling, if so, simultaneously acquiring the number of the radio frequency tag, and predicting the current position of the unmanned vehicle on the path track according to the number of the radio frequency tag.
8. An unmanned vehicle line patrol system based on self-learning radio frequency tags is characterized in that a plurality of radio frequency tags with unique numbers are arranged on a path to be patrolled; characterized in that the system comprises:
the self-learning module is used for acquiring path information on the path to be patrolled by a self-learning method; the path information at least comprises the number of each radio frequency tag on the path to be patrolled and the arrangement sequence of the radio frequency tags;
the system comprises a plurality of detection antennas, a radio frequency identification device and a wireless communication device, wherein the detection antennas are arranged at the front end of an unmanned vehicle so as to detect the radio frequency identification and the serial number thereof in front of the unmanned vehicle in real time in the process of the unmanned vehicle;
the traveling direction planning module is used for confirming a target label to be passed by the next target label on the path according to the arrangement sequence of the radio frequency labels and confirming the current traveling direction according to the signal strength between the plurality of detection antennas and the target label;
and the motion control module is used for controlling the unmanned vehicle to pass through the target label along the advancing direction.
9. The self-learning radio frequency tag based automatic unmanned vehicle line patrol system according to claim 8, wherein the unmanned vehicle comprises a first detection antenna and a second detection antenna which are arranged side by side at the front end of a vehicle body;
the advancing direction planning module is used for respectively acquiring the signal strength between the first detection antenna and the target radio frequency tag and the signal strength between the second detection antenna and the target radio frequency tag, judging whether the signal strength corresponding to the first detection antenna is equal to that corresponding to the second detection antenna, if so, determining that the direction opposite to the unmanned vehicle is the advancing direction, and controlling the unmanned vehicle to linearly advance along the advancing direction and pass through the target radio frequency tag;
if not, determining the direction of one side of the first detection antenna and the second detection antenna, where the antenna with the smaller corresponding signal strength is located, as a fine adjustment direction, controlling the unmanned vehicle to adjust the direction of the vehicle head towards the fine adjustment direction when the unmanned vehicle travels until the signal strengths corresponding to the first detection antenna and the second detection antenna are equal, then taking the direction opposite to the unmanned vehicle as the traveling direction, and controlling the unmanned vehicle to travel linearly along the traveling direction and pass through the target tag.
10. The self-learning radio frequency tag based automatic unmanned aerial vehicle line patrol system as claimed in claim 9, wherein the unmanned aerial vehicle further comprises a fourth detecting antenna and a fifth detecting antenna arranged at the rear end of the vehicle body;
the motion control module is further used for detecting the radio frequency tag located behind the vehicle body through the fourth detection antenna and the fifth detection antenna when the unmanned vehicle linearly advances along the advancing direction, respectively acquiring the signal strength between the fourth detection antenna and the radio frequency tag located behind the vehicle body, judging whether the signal strength corresponding to the fourth detection antenna is equal to that corresponding to the fifth detection antenna, and if so, improving the advancing speed of the unmanned vehicle according to a preset speed regulation method.
11. The self-learning radio frequency tag based automated unmanned vehicle routing system of claim 10, wherein the controlling the unmanned vehicle to adjust a heading direction toward the fine adjustment direction while traveling comprises:
and controlling the unmanned vehicle to move, and adjusting the direction opposite to the head of the unmanned vehicle according to a preset adjusting speed and the fine adjustment method.
12. The system of claim 11, wherein the self-learning module is further configured to obtain adjustment information of a direction of a head between every two adjacent tags and distance information between every two adjacent tags through a self-learning method during the traveling of the unmanned vehicle; the path information also comprises adjustment information of the direction of the vehicle head between every two adjacent tags and distance information between every two adjacent tags;
the automatic line patrol system of the unmanned vehicle further comprises a path planning module used for planning the path track of the line to be patrolled according to the path information.
13. The self-learning radio frequency tag based automatic unmanned aerial vehicle line patrol system as claimed in claim 12, wherein the unmanned aerial vehicle further comprises a sixth detection antenna disposed at the bottom of the vehicle body;
the automatic unmanned vehicle line patrol system further comprises a positioning module, wherein the positioning module is used for detecting whether the unmanned vehicle is located above a certain radio frequency tag currently or not through the sixth detection antenna in the process of the unmanned vehicle traveling, and if so, the number of the radio frequency tag is obtained at the same time, and the current position of the unmanned vehicle on the path track is predicted according to the number of the radio frequency tag.
14. An unmanned vehicle based on self-learning radio frequency tag line patrol, characterized by comprising the unmanned vehicle line patrol system according to any one of claims 8-13.
CN202010150030.6A 2020-03-06 2020-03-06 Unmanned vehicle line inspection method and system based on self-learning radio frequency tag and unmanned vehicle Active CN111352422B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010150030.6A CN111352422B (en) 2020-03-06 2020-03-06 Unmanned vehicle line inspection method and system based on self-learning radio frequency tag and unmanned vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010150030.6A CN111352422B (en) 2020-03-06 2020-03-06 Unmanned vehicle line inspection method and system based on self-learning radio frequency tag and unmanned vehicle

Publications (2)

Publication Number Publication Date
CN111352422A true CN111352422A (en) 2020-06-30
CN111352422B CN111352422B (en) 2023-04-28

Family

ID=71197360

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010150030.6A Active CN111352422B (en) 2020-03-06 2020-03-06 Unmanned vehicle line inspection method and system based on self-learning radio frequency tag and unmanned vehicle

Country Status (1)

Country Link
CN (1) CN111352422B (en)

Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000214926A (en) * 1999-01-22 2000-08-04 Sogo Keibi Hosho Co Ltd Travel position detecting means for autonomous mobile
JP2002236167A (en) * 2001-02-08 2002-08-23 Fujitsu Ten Ltd Radar mounting direction adjusting device and radar mounting direction adjusting method
CN102356367A (en) * 2009-01-17 2012-02-15 布穆朗***有限公司 Variable offset positioning antenna array for enhanced guidance of automated guided vehicles (agvs)
CN202586115U (en) * 2012-04-11 2012-12-05 中国农业大学 Thermal image temperature measuring and fault location inspection robot system
CN102955476A (en) * 2012-11-12 2013-03-06 宁波韵升股份有限公司 Automatic guided vehicle (AGV) path planning method based on radio frequency identification (RFID) technology
CN203503000U (en) * 2013-09-30 2014-03-26 上海交通大学 System for supplying materials for mixed assembling production line based on RFID
CN104134054A (en) * 2014-08-06 2014-11-05 北京烽火联拓科技有限公司 Identification method and system for motion state of radio frequency identification tags
CN107844895A (en) * 2017-10-20 2018-03-27 四川省守望信息科技有限责任公司 Megastore's shopping cart management system
CN108736933A (en) * 2018-04-27 2018-11-02 常熟市天然气有限公司 Unmanned plane line walking detecting system based on RF tag Yu wireless relay remote argon plasma
WO2019014277A1 (en) * 2017-07-10 2019-01-17 Travelmate Robotics, Inc. Autonomous robot system
CN109308772A (en) * 2017-07-26 2019-02-05 广东顺德中山大学卡内基梅隆大学国际联合研究院 Books in libraries check system and its checking method based on RFID technique
CN109323696A (en) * 2018-11-07 2019-02-12 航天信息股份有限公司 A kind of unmanned fork lift indoor positioning navigation system and air navigation aid
CN109765904A (en) * 2019-02-28 2019-05-17 上海木木聚枞机器人科技有限公司 A kind of guidance control method and mobile device of mobile device disengaging narrow space
CN110806205A (en) * 2019-10-30 2020-02-18 华中科技大学 Micro unmanned aerial vehicle navigation method based on passive radio frequency tag

Patent Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000214926A (en) * 1999-01-22 2000-08-04 Sogo Keibi Hosho Co Ltd Travel position detecting means for autonomous mobile
JP2002236167A (en) * 2001-02-08 2002-08-23 Fujitsu Ten Ltd Radar mounting direction adjusting device and radar mounting direction adjusting method
CN102356367A (en) * 2009-01-17 2012-02-15 布穆朗***有限公司 Variable offset positioning antenna array for enhanced guidance of automated guided vehicles (agvs)
CN202586115U (en) * 2012-04-11 2012-12-05 中国农业大学 Thermal image temperature measuring and fault location inspection robot system
CN102955476A (en) * 2012-11-12 2013-03-06 宁波韵升股份有限公司 Automatic guided vehicle (AGV) path planning method based on radio frequency identification (RFID) technology
CN203503000U (en) * 2013-09-30 2014-03-26 上海交通大学 System for supplying materials for mixed assembling production line based on RFID
CN104134054A (en) * 2014-08-06 2014-11-05 北京烽火联拓科技有限公司 Identification method and system for motion state of radio frequency identification tags
WO2019014277A1 (en) * 2017-07-10 2019-01-17 Travelmate Robotics, Inc. Autonomous robot system
CN109308772A (en) * 2017-07-26 2019-02-05 广东顺德中山大学卡内基梅隆大学国际联合研究院 Books in libraries check system and its checking method based on RFID technique
CN107844895A (en) * 2017-10-20 2018-03-27 四川省守望信息科技有限责任公司 Megastore's shopping cart management system
CN108736933A (en) * 2018-04-27 2018-11-02 常熟市天然气有限公司 Unmanned plane line walking detecting system based on RF tag Yu wireless relay remote argon plasma
CN109323696A (en) * 2018-11-07 2019-02-12 航天信息股份有限公司 A kind of unmanned fork lift indoor positioning navigation system and air navigation aid
CN109765904A (en) * 2019-02-28 2019-05-17 上海木木聚枞机器人科技有限公司 A kind of guidance control method and mobile device of mobile device disengaging narrow space
CN110806205A (en) * 2019-10-30 2020-02-18 华中科技大学 Micro unmanned aerial vehicle navigation method based on passive radio frequency tag

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
卢忠亮 等: "基于射频识别的智能物流小车", 《江西理工大学学报》 *

Also Published As

Publication number Publication date
CN111352422B (en) 2023-04-28

Similar Documents

Publication Publication Date Title
KR100478452B1 (en) Localization apparatus and method for mobile robot
CN107851386B (en) Method and system for locating a vehicle located within a parking lot
US8587455B2 (en) Localisation of vehicle or mobile objects based on embedded RFID tags
EP3480673A1 (en) Mobile body guidance system, mobile body, guidance device, and computer program
US20160318415A1 (en) Apparatus and method for automated positioning of a vehicle
US11173799B2 (en) Method for guiding a motor vehicle into a charging position at an inductive charging station, and control device and motor vehicle
CN111273672B (en) Unmanned aerial vehicle line inspection method and system based on known coordinate radio frequency tag and unmanned aerial vehicle
US11828610B2 (en) Roadway information detection sensor device/system for autonomous vehicles
CN110398251B (en) Trackless navigation AGV positioning system based on multi-sensor fusion and positioning method thereof
CN104102217A (en) System and method for detecting running state of carrying vehicle
CN110763224A (en) Navigation method and navigation system for automatic guided transport vehicle
CN110723019A (en) Wireless charging guiding and positioning system and method and vehicle-mounted equipment
CN111204238A (en) Wireless charging alignment method and device for automobile, storage medium and terminal
CN111324134B (en) Unmanned vehicle line inspection method and system based on preset sequence radio frequency tags and unmanned vehicle
JP2012026888A (en) Own-vehicle location recognition device
CN113703446B (en) Guide vehicle navigation method and dispatch system based on magnetic nails
CN113670332A (en) Calibration method for obtaining installation pose of AGV vehicle-mounted positioning sensor
CN111352422B (en) Unmanned vehicle line inspection method and system based on self-learning radio frequency tag and unmanned vehicle
CN212112229U (en) Unmanned vehicle with label detection function
CN115004276A (en) Automatic parking/picking method for parking lot, parking lot system and vehicle terminal
US11086332B2 (en) Navigation method and system
CN111791922A (en) Method and device for identifying forked tracks of intelligent rail car
JP4694599B2 (en) Unmanned vehicle
CN114815800A (en) Self-position estimation accuracy verification method and self-position estimation system
US10403139B2 (en) Local navigation system for vehicle navigation

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