[go: up one dir, main page]

CN104142685B - AGV trackless guidance method and system based on optical alignment - Google Patents

AGV trackless guidance method and system based on optical alignment Download PDF

Info

Publication number
CN104142685B
CN104142685B CN201410416229.3A CN201410416229A CN104142685B CN 104142685 B CN104142685 B CN 104142685B CN 201410416229 A CN201410416229 A CN 201410416229A CN 104142685 B CN104142685 B CN 104142685B
Authority
CN
China
Prior art keywords
agv
line
current time
equation
control parameter
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.)
Active
Application number
CN201410416229.3A
Other languages
Chinese (zh)
Other versions
CN104142685A (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.)
Suzhou Jiashun Intelligent Robot Co ltd
Original Assignee
Shenzhen Casun Intelligent Robot 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 Shenzhen Casun Intelligent Robot Co Ltd filed Critical Shenzhen Casun Intelligent Robot Co Ltd
Priority to CN201410416229.3A priority Critical patent/CN104142685B/en
Publication of CN104142685A publication Critical patent/CN104142685A/en
Application granted granted Critical
Publication of CN104142685B publication Critical patent/CN104142685B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The present invention is suitable for automatic field, a kind of AGV trackless guidance method based on optical alignment is provided, described method includes following steps: two displacement informations of AGV car body is obtained by least two optical positioning sensors, two displacement informations are respectively as follows: S1 and S2;Go out coordinate value and the azimuth at current time by discrete motion equation calculation according to S1, S2;It is deviated control parameter according to the equation calculation of the coordinate value of the current time, azimuth and default route;Deviation control parameter input driving control system control AGV route is travelled by setting path.Technical solution provided by the invention makes AGV carry out autonomous positioning using optical positioning sensors, determines the position AGV and posture information, so that trackless guiding is done directly, the advantages of without being laid with track.

Description

AGV trackless guiding method and system based on optical positioning
Technical Field
The invention belongs to the field of automation, and particularly relates to an AGV trackless guiding method and system based on optical positioning.
Background
Automated Guided Vehicle (AGV) systems have evolved into one of the largest specialized branches of production flow systems. The guidance technology can be mainly divided into two aspects, namely rail guidance and trackless guidance. The most basic automatic guidance technology in AGVs at present mainly includes electromagnetic induction guidance, magnetic tape guidance, visual guidance, laser guidance, inertial navigation guidance, ultrasonic guidance, and the like. The visual guidance technology is one of the hot spots of research in the AGV industry at home and abroad in recent years, the visual sensor is based on optical signals, has high response speed, is not easily influenced by electromagnetic interference and environment, and has strong adaptability, so the visual guidance technology has great development potential. However, in the existing visual guidance method, the color tape or the guidance tape laid on the ground is usually used, and the guidance of the AGV is realized by processing the color tape image signal collected by the camera or the visual sensor to a certain degree.
Visual guidance AGV systems and methods such as prior art (CN102608998A) embedded systems; in the prior art, an embedded hardware system is formed by adopting a DSP (digital signal processor), an ARM (advanced RISC machine) processor and an FPGA (field programmable gate array) as a coprocessor, and the AGV is guided after image information of a path acquired by a camera is processed. The technical method adopted by the method needs to lay a black or white color band on the running route of the trolley to obtain the path information, and belongs to a rail guide mode.
For example, another prior art (CN103064417A) is a multi-sensor based global positioning guidance system and method; the method also adopts a visual sensor, although global positioning guidance is carried out based on multiple sensors, the prior art still adopts a guidance belt paved on the ground of the AGV body working area to realize AGV guidance, and still belongs to a rail guidance mode.
In the scheme for realizing the prior art, the following technical problems are found in the prior art:
the prior art providesThe visual guidance technology cannot realize trackless guidance.
Disclosure of Invention
The embodiment of the invention aims to provide an AGV trackless guiding method and system based on optical positioning, and aims to solve the technical scheme in the prior artProvided withThe visual guidance technology can not realize trackless guidance.
In a first aspect, an AGV trackless guidance method based on optical positioning is provided, where the method includes the following steps:
two pieces of displacement information of AGV automobile body are obtained through two at least optical positioning sensors, and two pieces of displacement information are respectively: s1 and S2;
calculating the coordinate value and the azimuth angle of the current moment through a discrete motion equation according to S1 and S2;
calculating a deviation control parameter according to the coordinate value and the azimuth of the current time and an equation of a preset route;
and inputting the deviation control parameters into a driving control system to control the AGV to run according to a set route.
Optionally, the discrete equation of motion specifically includes:
wherein T represents the time of two adjacent samples, Tn represents the time of the nth sample, S1(Tn) the first displacement of the Tn th sample, S2(Tn) the second displacement of the Tn th sample, T represents the current time, and X (T) represents the X-axis coordinate of the current time; y (t) represents a Y-axis coordinate of the current time t, θ (t) represents an azimuth angle of the current time, and X (0) represents an X-axis coordinate of the starting point (0); y (0) represents the Y-axis coordinate of the start point (0), and θ (0) represents the azimuth angle of the start point (0).
Optionally, the calculating of the deviation control parameter according to the coordinate value of the current time, the azimuth angle, and the equation of the preset route specifically includes:
the equation of the preset route is specifically as follows: ax + by + c is 0;
θ (t) - θ (line);
wherein theta (t) represents the azimuth angle at the current moment, and theta (line) represents the included angle of the preset route; MN denotes a deviation control parameter.
Optionally, after the deviation control parameter is input into the driving control system to control the AGV to run along the set route, the method further includes:
when the AGV body needs to switch the line, after the AGV body is determined to be in the switching range according to the coordinate value and the azimuth angle of the current time, the switched deviation control parameter is calculated according to the coordinate value and the azimuth angle of the current time and the equation of the switched line, and the switched deviation control parameter is input into the driving control system to control the AGV line to run according to the switched line.
Optionally, after determining that the AGV body is within the switching range according to the coordinate value and the azimuth of the current time, calculating a switched deviation control parameter according to the coordinate value and the azimuth of the current time and an equation of the switched route specifically includes:
the equation of the switched line may specifically be: a 'x + b' y + c ═ 0;
θ (t) - θ (line)';
where θ (line) 'represents the angle of the line after switching, and MN' is the deviation control parameter after switching.
In another aspect, an AGV trackless guidance system based on optical positioning is provided, the system comprising: positioning system, navigation system and drive control system, positioning system includes: at least two optical position sensors and a light source cooperating with the at least two optical equipotential sensors; wherein,
positioning system is used for acquireing two displacement information of AGV automobile body, and two displacement information do respectively: s1 and S2, and transmitting the two pieces of displacement information to a navigation system;
the navigation system is used for calculating the coordinate value and the azimuth angle of the current moment through a discrete motion equation according to S1 and S2; calculating a deviation control parameter according to the coordinate value and the azimuth of the current time and an equation of a preset route; the navigation system transmits the deviation control parameters to a driving control system;
and the driving control system is used for controlling the AGV to run according to the set route according to the deviation control parameter.
Optionally, the discrete equation of motion specifically includes:
wherein T represents the time of two adjacent samples, Tn represents the time of the nth sample, S1(Tn) the first displacement of the Tn th sample, S2(Tn) the second displacement of the Tn th sample, T represents the current time, and X (T) represents the X-axis coordinate of the current time; y (t) represents a Y-axis coordinate of the current time t, θ (t) represents an azimuth angle of the current time, and X (0) represents an X-axis coordinate of the starting point (0); y (0) represents the Y-axis coordinate of the start point (0), and θ (0) represents the azimuth angle of the start point (0).
Optionally, the navigation system is specifically configured to:
the equation of the preset route is specifically as follows: ax + by + c is 0;
θ (t) - θ (line);
wherein theta (t) represents the azimuth angle at the current moment, and theta (line) represents the included angle of the preset route; MN denotes a deviation control parameter.
Alternatively to this, the first and second parts may,
when the AGV body needs to switch the line, the navigation system is further used for determining that the AGV body is in the switching range according to the coordinate value and the azimuth angle of the current time, calculating a switched deviation control parameter according to the coordinate value and the azimuth angle of the current time and an equation of the switched route, and inputting the switched deviation control parameter into the driving control system;
and the driving control system is also used for controlling the AGV to run according to the switched route according to the switched deviation control parameters.
Optionally, the navigation system is specifically configured to:
the equation of the switched line may specifically be: a 'x + b' y + c ═ 0;
θ (t) - θ (line)';
where θ (line) 'represents the angle of the line after switching, and MN' is the deviation control parameter after switching.
In the embodiment of the invention, the technical scheme provided by the invention adopts the optical positioning sensor to automatically position the AGV and determine the position and attitude information of the AGV, thereby directly completing trackless guidance without laying a track.
Drawings
FIG. 1 is a block diagram of an AGV trackless guidance system based on optical positioning provided by the present invention,
FIG. 2 is a schematic view of an optical positioning sensor with a laser light source;
FIG. 3 is a schematic view of the mounting position of the optical locating sensor;
FIG. 4 is an algorithmic resolution of the optical position sensor locating the position attitude (x0, y0, θ 0) of the AGV;
FIG. 5 is an analytic graph of deviation control parameter algorithm of navigation coordinates in the AGV traveling process;
FIG. 6 is a schematic diagram illustrating a route switching processing manner during the driving of an AGV;
FIG. 7 is a flowchart of an AGV trackless guidance method based on optical positioning according to the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention.
The specific embodiment of the invention provides an AGV trackless guiding method based on optical positioning, which is shown in fig. 7 and comprises the following steps:
101. two pieces of displacement information of AGV automobile body are obtained through two at least optical positioning sensors, and two pieces of displacement information are respectively: s1 and S2;
102. calculating the coordinate value and the azimuth angle of the current moment through a discrete motion equation according to S1 and S2;
103. calculating a deviation control parameter according to the coordinate value and the azimuth of the current time and an equation of a preset route;
104. and inputting the deviation control parameters into a driving control system to control the AGV to run according to a set route.
Optionally, the discrete equation of motion may specifically be:
wherein T represents the time of two adjacent samples, Tn represents the time of the nth sample, S1(Tn) the first displacement of the Tn th sample, S2(Tn) the second displacement of the Tn th sample, T represents the current time, and X (T) represents the X-axis coordinate of the current time; y (t) represents a Y-axis coordinate of the current time t, θ (t) represents an azimuth angle of the current time, and X (0) represents an X-axis coordinate of the starting point (0); y (0) represents the Y-axis coordinate of the start point (0), and θ (0) represents the azimuth angle of the start point (0).
Optionally, the implementation method of 103 may specifically be: the equation for the preset route may specifically be: ax + by + c is 0;
θ (t) - θ (line);
wherein theta (t) represents the azimuth angle at the current moment, and theta (line) represents the included angle of the preset route; MN denotes a deviation control parameter.
Optionally, after 104, the method may further include:
when the AGV body needs to switch the line, after the AGV body is determined to be in the switching range according to the coordinate value and the azimuth angle of the current time, the switched deviation control parameter is calculated according to the coordinate value and the azimuth angle of the current time and the equation of the switched line, and the switched deviation control parameter is input into the driving control system to control the AGV line to run according to the switched line.
The specific implementation mode is as follows:
the equation of the switched line may specifically be: a 'x + b' y + c ═ 0;
θ (t) - θ (line)';
where θ (line) 'represents the angle of the line after switching, and MN' is the deviation control parameter after switching.
The specific implementation mode of the invention also provides an AGV trackless guiding system based on optical positioning, which comprises: positioning system, navigation system and drive control system, positioning system includes: at least two optical position sensors and a light source cooperating with the at least two optical equipotential sensors; wherein,
positioning system is used for acquireing two displacement information of AGV automobile body, and two displacement information do respectively: s1 and S2, and transmitting the two pieces of displacement information to a navigation system;
the navigation system is used for calculating the coordinate value and the azimuth angle of the current moment through a discrete motion equation according to S1 and S2; calculating a deviation control parameter according to the coordinate value and the azimuth of the current time and an equation of a preset route; the navigation system transmits the deviation control parameters to a driving control system;
and the driving control system is used for controlling the AGV to run according to the set route according to the deviation control parameter.
Optionally, the discrete equation of motion specifically includes:
wherein T represents the time of two adjacent samples, Tn represents the time of the nth sample, S1(Tn) the first displacement of the Tn th sample, S2(Tn) the second displacement of the Tn th sample, T represents the current time, and X (T) represents the X-axis coordinate of the current time; y (t) represents a Y-axis coordinate of the current time t, θ (t) represents an azimuth angle of the current time, and X (0) represents an X-axis coordinate of the starting point (0); y (0) represents the Y-axis coordinate of the start point (0), and θ (0) represents the azimuth angle of the start point (0).
Optionally, the navigation system is specifically configured to:
the equation of the preset route is specifically as follows: ax + by + c is 0;
θ (t) - θ (line);
wherein theta (t) represents the azimuth angle at the current moment, and theta (line) represents the included angle of the preset route; MN denotes a deviation control parameter.
Optionally, when the AGV needs to switch the line, the navigation system is further configured to determine that the AGV is within the switching range according to the coordinate value and the azimuth of the current time, calculate a switched deviation control parameter according to the coordinate value and the azimuth of the current time and an equation of the switched route, and input the switched deviation control parameter into the driving control system;
and the driving control system is also used for controlling the AGV to run according to the switched route according to the switched deviation control parameters.
Optionally, the navigation system is specifically configured to:
the equation of the switched line may specifically be: a 'x + b' y + c ═ 0;
θ (t) - θ (line)';
where θ (line) 'represents the angle of the line after switching, and MN' is the deviation control parameter after switching.
The principles of the present invention are briefly described below with reference to the accompanying drawings:
FIG. 1 is a block diagram of the AGV positioning system according to the present invention, wherein the AGV positioning system includes an optical positioning sensor and a position and attitude calculation, the optical positioning sensor is mounted on a driving wheel platform of the AGV body according to a certain mounting manner, and a motion equation of the AGV is calculated through a corresponding algorithm, so that the position and attitude information of the AGV at any time is calculated. And uploading the obtained position and posture information to an AGV route navigation system in a data format of a coordinate starting point (x0, y0, theta 0), wherein the coordinate of the starting point is a point determined by a user. The AGV route navigation system establishes a reference coordinate system according to the actual situation of the field. Based on the reference coordinate system, different route equations to be traveled by the AGV are set, and deviation control parameters Err are calculated by comparing the AGV coordinates and azimuth angle information (x0, y0, theta 0) with the route equations. The deviation control parameter Err is uploaded to the drive control system. The drive control system can use a PLC or a single chip microcomputer as a main control unit and drive the motor through a PID closed-loop control algorithm, so that the aim of driving the AGV according to a specified route is fulfilled.
Fig. 2 shows an irradiation mode in which the optical positioning sensor is provided with a laser light source. In order to enable the optical positioning sensor to work normally at a certain height from the ground, a light source in a certain wavelength range needs to be additionally arranged, and the embodiment adopts 650nm red line laser. The normal working height of the optical positioning sensor from the ground can be adjusted by adjusting the irradiation angle of the laser head. Therefore, the AGV can normally run under different ground environments. As shown in fig. 2, among others, a laser head 202, an optical positioning sensor 201, a photoreceptor lens 2011, and an AGV body 203.
Fig. 3 shows the mounting position of the optical position sensor. In the embodiment, two optical positioning sensors are adopted, and the installation of the two positioning sensors and the calculation of the corresponding position and attitude are provided. The optical positioning sensor is arranged at the bottom of a driving wheel platform of the AGV body, the installation position is equal to the distance between the two driving wheels and the central point O on the same axis, and the distance between the two optical positioning sensors AB is L. The mounting mode can ensure that the optical positioning sensor only returns to the displacement in the y-axis direction when moving, and does not return to the value in the x-axis direction.
FIG. 4 is an algorithmic resolution of the position attitude (x0, y0, θ 0) of the optical position sensor locating the AGV. The installation position of the optical positioning sensor can ensure that the optical positioning sensor does not return the displacement value of the AGV in the x-axis direction but only returns the displacement value in the y-axis direction when the AGV runs. The motion of any object can be regarded as inertial motion and the reference coordinate system can be regarded as a two-dimensional planar coordinate system. The position and attitude information of the object can be known by knowing the real-time speed of any two points of the object according to the law of the two-dimensional inertial platform. Then knowing the speed information of two points a and B of the AGV drive wheel platform, the equation of motion of the AGV drive wheel can be derived as follows:
let the coordinates of the point O at any time of AGV be (x0, y0), the azimuth angle be θ 0, the real-time speed of the point O be v0, and the angular speed be ω 0, then there are
If the real-time speed of the point A provided with the optical positioning sensor is vA, the real-time speed of the point B is vB and the distance between the two points is L, the real-time speed of the point A and the real-time speed of the point B are respectively vA and vB, and the distance between the two points is L
The equation of motion of the O point of the AGV driving wheel platform can be deduced as follows:
in the formula, [ x (0), y (0), θ (0) ] represents the coordinates and azimuth angle at the initial time.
Since the data read from the optical positioning sensor is periodic discrete data when the software program is written, the obtained data is A, B displacement information of two points, the sampling time of each period is short, and the arc length of motion of A, B two points in each sampling period is short, so that the displacement can be approximated to a straight line displacement, which is S2 and S1 respectively. Assuming that the sampling period is Tn, where (n is 1,2,3 … …), and T1 is T2 is T3 is T … … is T, the arc length displacement of the two-point sampling in the nth period AB can be represented as S2(Tn) and S1(Tn), respectively. Discretizing the motion equation of the O point to obtain a motion equation beneficial to programming, wherein the motion equation is as follows:
when the angle is used for calculating the coordinate, the value of the angle is taken as the weighted average value of the angle value at the previous moment and the angle value at the current moment, so that the sampling and calculation errors are reduced. From this equation of motion, the coordinates and azimuth [ x (t), y (t), θ (t) ] for the AGV at any one time are obtained. And uploading the position and the posture to a route navigation system, and calculating a deviation control parameter for controlling a motor to drive the AGV to run.
FIG. 5 is an analytic graph of deviation control parameter algorithm of navigation coordinates during AGV traveling. Given the algorithmic analysis of a straight Line, the straight Line equation of a Line in the established reference coordinate system is ax + by + c, where ax + by + c is 0, the azimuth angle of the Line is θ 1, and the coordinates and azimuth angle of the AGV are (x0, y0, θ 0). And in order to better control the AGV to run according to the appointed route, selecting N point coordinates (x1, y1) which lead the ON distance along the azimuth angle of the AGV as control coordinates so as to achieve the purpose of advanced correction. Passing through the N points, making a perpendicular Line perpendicular to the ON direction and crossing the Line at the M point. The length of the line segment MN is used as the deviation control parameter Err to be controlled. The calculation is as follows:
distance NP from N point to Line of
ByThe length Err of the MN can be calculated.
The deviation control parameter Err calculated in this way can reflect the deviation between the AGV coordinates and the route, and also reflects the relative relationship between the azimuth angle of the AGV and the azimuth angle of the route. And uploading the deviation control parameter Err to a drive control system, and controlling the AGV to run according to the designated route through PID control.
Fig. 6 shows a route switching processing method during the travel of the AGV. When the AGV switches the travel from the Line1 to the Line2, the control coordinates of the AGV are (x1, y1), the switching point Q is the intersection of the Line1 and the Line2, and the coordinates are (x2, y 2). Since the control coordinates of the AGV are not always on the route trajectory Line1, a fault-tolerant process is required when the route is switched. The point Q is used as the center of a circle, the switching radius is r to make a circle, when the point N moves into the switching circle, the switching of the reference route is carried out, namely, when | x2-x1| < ═ r and | y2-y1| < | >, the reference route is switched to Line2 from Line1, and therefore the AGV can be guaranteed to normally carry out route switching.
The above description is only for the purpose of illustrating the preferred embodiments of the present invention and is not to be construed as limiting the invention, and any modifications, equivalents and improvements made within the spirit and principle of the present invention are intended to be included within the scope of the present invention.

Claims (8)

1. An AGV trackless guiding method based on optical positioning is characterized by comprising the following steps:
two pieces of displacement information of AGV automobile body are obtained through two at least optical positioning sensors, and two pieces of displacement information are respectively: s1 and S2;
calculating the coordinate value and the azimuth angle of the current moment through a discrete motion equation according to S1 and S2;
calculating a deviation control parameter according to the coordinate value and the azimuth of the current time and an equation of a preset route;
inputting the deviation control parameters into a driving control system to control the AGV to run according to a set route;
the discrete motion equation is specifically as follows:
wherein T represents the time of two adjacent samples, Tn represents the time of the nth sample, S1(Tn) the first displacement of the Tn th sample, S2(Tn) the second displacement of the Tn th sample, T represents the current time, and X (T) represents the X-axis coordinate of the current time; y (t) represents a Y-axis coordinate of the current time t, θ (t) represents an azimuth angle of the current time, and X (0) represents an X-axis coordinate of the starting point (0); y (0) represents the Y-axis coordinate of the starting point (0), θ (0) represents the azimuth angle of the starting point (0), and L represents the distance between the two optical positioning sensors.
2. The method of claim 1, wherein the calculating the deviation control parameter according to the coordinate value of the current time, the azimuth angle and the equation of the preset route comprises:
the equation of the preset route is specifically as follows: ax + by + c is 0;
θ (t) - θ (line);
wherein theta (t) represents the azimuth angle at the current moment, and theta (line) represents the included angle of the preset route; MN denotes a deviation control parameter.
3. The method of claim 1, further comprising, after inputting the deviation control parameter into the drive control system to control the AGV to route the AGV line:
when the AGV body needs to switch the line, after the AGV body is determined to be in the switching range according to the coordinate value and the azimuth angle of the current time, the switched deviation control parameter is calculated according to the coordinate value and the azimuth angle of the current time and the equation of the switched line, and the switched deviation control parameter is input into the driving control system to control the AGV line to run according to the switched line.
4. The method according to claim 3, wherein after determining that the AGV body is within the switching range according to the coordinate value and the azimuth of the current time, the calculating of the switched deviation control parameter according to the coordinate value and the azimuth of the current time and the equation of the switched route includes:
the equation of the switched line may specifically be: a 'x + b' y + c ═ 0;
θ (t) - θ (line)';
where θ (line) 'represents the angle of the line after switching, and MN' is the deviation control parameter after switching.
5. An optical positioning based AGV trackless guidance system, the system comprising: positioning system, navigation system and drive control system, positioning system includes: at least two optical positioning sensors and a light source cooperating with the at least two optical positioning sensors; wherein,
positioning system is used for acquireing two displacement information of AGV automobile body, and two displacement information do respectively: s1 and S2, and transmitting the two pieces of displacement information to a navigation system;
the navigation system is used for calculating the coordinate value and the azimuth angle of the current moment through a discrete motion equation according to S1 and S2; calculating a deviation control parameter according to the coordinate value and the azimuth of the current time and an equation of a preset route; the navigation system transmits the deviation control parameters to a driving control system;
the driving control system is used for controlling the AGV to run according to a set route according to the deviation control parameter;
the discrete motion equation is specifically as follows:
wherein T represents the time of two adjacent samples, Tn represents the time of the nth sample, S1(Tn) the first displacement of the Tn th sample, S2(Tn) the second displacement of the Tn th sample, T represents the current time, and X (T) represents the X-axis coordinate of the current time; y (t) represents a Y-axis coordinate of the current time t, θ (t) represents an azimuth angle of the current time, and X (0) represents an X-axis coordinate of the starting point (0); y (0) represents the Y-axis coordinate of the starting point (0), θ (0) represents the azimuth angle of the starting point (0), and L represents the distance between the two optical positioning sensors.
6. The system of claim 5, wherein the navigation system is specifically configured to:
the equation of the preset route is specifically as follows: ax + by + c is 0;
θ (t) - θ (line);
wherein theta (t) represents the azimuth angle at the current moment, and theta (line) represents the included angle of the preset route; MN denotes a deviation control parameter.
7. The system of claim 5,
when the AGV body needs to switch the line, the navigation system is further used for determining that the AGV body is in the switching range according to the coordinate value and the azimuth angle of the current time, calculating a switched deviation control parameter according to the coordinate value and the azimuth angle of the current time and an equation of the switched route, and inputting the switched deviation control parameter into the driving control system;
and the driving control system is also used for controlling the AGV to run according to the switched route according to the switched deviation control parameters.
8. The system of claim 7, wherein the navigation system is specifically configured to:
the equation of the switched line may specifically be: a 'x + b' y + c ═ 0;
θ (t) - θ (line)';
where θ (line) 'represents the angle of the line after switching, and MN' is the deviation control parameter after switching.
CN201410416229.3A 2014-08-21 2014-08-21 AGV trackless guidance method and system based on optical alignment Active CN104142685B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410416229.3A CN104142685B (en) 2014-08-21 2014-08-21 AGV trackless guidance method and system based on optical alignment

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410416229.3A CN104142685B (en) 2014-08-21 2014-08-21 AGV trackless guidance method and system based on optical alignment

Publications (2)

Publication Number Publication Date
CN104142685A CN104142685A (en) 2014-11-12
CN104142685B true CN104142685B (en) 2019-08-16

Family

ID=51851888

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410416229.3A Active CN104142685B (en) 2014-08-21 2014-08-21 AGV trackless guidance method and system based on optical alignment

Country Status (1)

Country Link
CN (1) CN104142685B (en)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DK178276B1 (en) * 2014-12-19 2015-10-26 Conpleks Innovation Aps Method for recording and predicting position data for a selfpropelled wheeled vehicle, and delivery or pick up system comprising a self-propelled, self-guided wheeled vehicle
CN105136120A (en) * 2015-08-24 2015-12-09 陈建武 Object displacement image detection system and method
CN106940183B (en) * 2016-12-13 2019-08-09 北京卫星制造厂 A kind of AGV accurate positioning method based on PSD ranging
CN108616676B (en) * 2016-12-30 2020-11-06 艾迪普科技股份有限公司 Switching method for dynamic change of camera track in virtual scene
CN107525510B (en) * 2017-08-30 2021-07-27 广州市井源机电设备有限公司 Control system and method for visual navigation type AGV
CN109491374B (en) * 2017-09-12 2022-08-09 杭州海康机器人技术有限公司 Track adjusting method and device for automatic guided vehicle
CN109515552B (en) * 2018-11-22 2021-01-01 安庆师范大学 An automatic guided vehicle suitable for logistics
CN111045404A (en) * 2019-12-09 2020-04-21 上海交通大学 Narrow roadway positioning stacking vehicle, positioning system and positioning method of stacking vehicle
CN112978239A (en) * 2021-02-08 2021-06-18 江苏惊蛰智能科技有限公司 Automatic guide transfer robot based on indoor infrared optical multi-curved-surface positioning technology

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20050007241A (en) * 2004-12-20 2005-01-17 부산대학교 산학협력단 Absolute-position detection method and algorithm of spreader for the auto-landing of containers
CN102032892A (en) * 2009-09-29 2011-04-27 通用电气公司 Azimuth angle measurement system and method for operating the same
CN102081493A (en) * 2009-12-01 2011-06-01 宏碁股份有限公司 Mobile electronic device and control method for three-dimensional operation interface thereof
CN102980555A (en) * 2012-12-06 2013-03-20 紫光股份有限公司 Method and device for detecting direction of optical imaging type wheeled mobile robot

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20050007241A (en) * 2004-12-20 2005-01-17 부산대학교 산학협력단 Absolute-position detection method and algorithm of spreader for the auto-landing of containers
CN102032892A (en) * 2009-09-29 2011-04-27 通用电气公司 Azimuth angle measurement system and method for operating the same
CN102081493A (en) * 2009-12-01 2011-06-01 宏碁股份有限公司 Mobile electronic device and control method for three-dimensional operation interface thereof
CN102980555A (en) * 2012-12-06 2013-03-20 紫光股份有限公司 Method and device for detecting direction of optical imaging type wheeled mobile robot

Also Published As

Publication number Publication date
CN104142685A (en) 2014-11-12

Similar Documents

Publication Publication Date Title
CN104142685B (en) AGV trackless guidance method and system based on optical alignment
CN108592906B (en) AGV composite navigation method based on two-dimensional code and inertial sensor
KR101526639B1 (en) Automatic guided vehicle and travel control method
US10261511B2 (en) Mobile body and position detection device
JP2023500082A (en) ROBOT GENERAL CHARGING STAND RETURN CHARGING CONTROL METHOD, CHIP AND ROBOT
CN111070205B (en) Pile alignment control method and device, intelligent robot and storage medium
CN106647741A (en) Laser-navigation-based omnibearing motion mechanism control system
CN103383567A (en) Driverless transport vehicle and method for operating driverless transport vehicle
CN207037462U (en) Embedded control system of AGV car based on ROS
CN108196554A (en) A kind of AGV Integrated guidance systems based on magnetic inductor and gyroscope
CN109900273B (en) A kind of outdoor mobile robot guidance method and guidance system
CN102183251A (en) Electromagnetic tracking method based on inductance coil
CN110147100A (en) A kind of AGV platform and air navigation aid with high-precision navigation locating function
JP2579808B2 (en) Mobile object guidance method and device
CN103777630A (en) Positioning navigation system and control method thereof
CN112947487A (en) Automatic guide vehicle and curve path tracking method and control device thereof
JP2011141663A (en) Automated guided vehicle and travel control method for the same
JP7043847B2 (en) Automated guided vehicle control system and control method
CN115164870A (en) An indoor autonomous relative positioning and navigation method under the air-ground cooperation mode
CN112462762A (en) Robot outdoor autonomous moving system and method based on roadside two-dimensional code unit
CN110320913A (en) The unmanned control device and method of low speed
JP2015055906A (en) POSITION DETECTION DEVICE AND MOBILE BODY SYSTEM FOR OUTPUT OF CONTROL COMMAND TO MOBILE RUNNING CONTROL UNIT
KR101440565B1 (en) The wireless guidance control method for AGV or mobile robot
CN106168802B (en) Position sensing device for mobile robot
JP2019215773A (en) Travel control device and travel control method for unmanned carrier

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
CB02 Change of applicant information

Address after: 518000 Guangdong Province, Shenzhen city Longhua District Mission and community and village -7 Yili Science Park No. 596 building C building 3-4 layer

Applicant after: SHENZHEN CASUN INTELLIGENT ROBOT Co.,Ltd.

Address before: 518000, Guangdong, Shenzhen, Longhua New District Guanlan street, South Road, Science Park, C building on the third floor

Applicant before: SHENZHEN CASUN TECHNOLOGY Co.,Ltd.

COR Change of bibliographic data
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CP03 Change of name, title or address

Address after: 215515 Building 1, miaoquan Industrial Park, Guli Town, Changshu City, Suzhou City, Jiangsu Province

Patentee after: Suzhou Jiashun intelligent robot Co.,Ltd.

Address before: 518000 floors 3-4, building C, Yili Science Park, No. 596-7 Dahe village, Guanlan Dahe community, Longhua new area, Shenzhen, Guangdong Province

Patentee before: SHENZHEN CASUN INTELLIGENT ROBOT Co.,Ltd.

CP03 Change of name, title or address