CN108549391B - AGV trolley control system and method - Google Patents

AGV trolley control system and method Download PDF

Info

Publication number
CN108549391B
CN108549391B CN201810517951.4A CN201810517951A CN108549391B CN 108549391 B CN108549391 B CN 108549391B CN 201810517951 A CN201810517951 A CN 201810517951A CN 108549391 B CN108549391 B CN 108549391B
Authority
CN
China
Prior art keywords
program module
agv
control
scheduling
instruction
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.)
Expired - Fee Related
Application number
CN201810517951.4A
Other languages
Chinese (zh)
Other versions
CN108549391A (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.)
Conprofe Technology Group Co Ltd
Original Assignee
Conprofe Technology Group 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 Conprofe Technology Group Co Ltd filed Critical Conprofe Technology Group Co Ltd
Priority to CN201810517951.4A priority Critical patent/CN108549391B/en
Publication of CN108549391A publication Critical patent/CN108549391A/en
Application granted granted Critical
Publication of CN108549391B publication Critical patent/CN108549391B/en
Expired - Fee Related 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/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • 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/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/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle

Landscapes

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

Abstract

The invention discloses an AGV trolley control system and a method, wherein the system comprises a server scheduling program module, a vehicle-mounted controller program module and an action execution program module, and the method comprises the following steps: the server scheduling program module performs AGVS scheduling on the AGV to generate an AGVS instruction; the vehicle-mounted controller program module controls the operation of the AGV according to the AGVS scheduling instruction of the server scheduling program module; and the action execution program module controls the AGV trolley to execute corresponding actions according to the operation control instruction. The invention can carry out coordinated dispatching on a plurality of AGV trolleys at the same time, and has high dispatching efficiency; the magnetic navigation tracking algorithm based on the parabola is adopted, so that the parameters needing to be set or debugged are relatively few, the method is easy to realize, the parameters are more stable, the parameters can be displayed in a matlab in a graphical interface mode, the method is more visual, and the debugging of large turns at different angles is facilitated. The invention can be widely applied to the field of logistics transportation equipment control.

Description

AGV trolley control system and method
Technical Field
The invention relates to the field of logistics transportation equipment control, in particular to an AGV trolley control system and an AGV trolley control method.
Background
With the rapid development of the B2C e-commerce industry, logistics warehousing becomes a bottleneck factor for the expansion of various industries. Like large-scale electronic commerce in China, no heavy money is available to research and develop a new generation of modern warehouse, but investment funds of most warehousing industries are spent in links of whole picking, shunting and the like. In the zero pick process, which affects warehouse efficiency most, the traditional manual approach of using no-move is still used, so an AGV cart with free path guidance is just an effective solution to this problem. AGVs are acronyms of Automated Guided vehicles (Automated Guided vehicles), and refer to transport vehicles equipped with an electromagnetic or optical automatic guide device, which can travel along a predetermined guide path, and which have safety protection and various transfer functions.
When the AGV works, the functions of starting, stopping, navigation, carrying and the like can be realized only by matching with an onboard controller and a corresponding scheduling server. However, most of the current dispatching servers of the AGV trolleys can only dispatch a single AGV trolley, and can not coordinate and dispatch a plurality of AGV trolleys at the same time, so that the dispatching efficiency is not high. In addition, when the on-board controller of the present AGV is tracking by magnetic navigation (magnetic navigation tracking for short), a fitting test is usually performed by using a PID algorithm to accurately position the position offset and the heading of the AGV, but the following disadvantages exist when the magnetic navigation tracking is performed by using the PID algorithm: 1) the parameters needing to be set or debugged are relatively more and are not easy to realize; 2) the parameters are not stable enough, cannot be displayed in a matlab in a graphical interface mode, and are not visual enough; 3) it is not convenient to debug large turns at different angles.
Disclosure of Invention
To solve the above technical problems, the present invention aims to: the AGV trolley control system and method are high in efficiency, easy to achieve, stable in parameters, visual and convenient.
The first technical scheme adopted by the invention is as follows:
AGV dolly control system includes:
the server scheduling program module is used for carrying out AGVS scheduling on the AGV, wherein the AGVS scheduling comprises AGV multi-vehicle cooperative scheduling;
the system comprises a vehicle-mounted controller program module, a server scheduling program module and a control system, wherein the vehicle-mounted controller program module is used for controlling the operation of the AGV according to an AGVS scheduling instruction of the server scheduling program module, and the operation control comprises the step of obtaining the position offset and the steering wheel direction speed of magnetic navigation by adopting a parabola-based magnetic navigation tracking algorithm;
and the action execution program module is used for controlling the AGV to execute corresponding actions according to the operation control instruction of the vehicle-mounted controller program module.
Further, the on-board controller program module includes:
the local area network subprogram module is used for receiving the AGVS scheduling instruction of the server scheduling program module and returning the result of the AGV trolley action execution to the server scheduling program module;
the AGV control system comprises an algorithm control subprogram module, a control module and a control module, wherein the algorithm control subprogram module is used for providing a control algorithm of the AGV, and the control algorithm of the AGV comprises a laser navigation algorithm and a magnetic navigation tracking algorithm;
the communication subprogram module is used for communicating with the action execution program module, sending an operation control instruction to the action execution program module and acquiring a sensor signal and a steering wheel action signal returned by the action execution program module;
and the IO control subprogram module is used for sending an operation control instruction to the action execution program module through the IO port so as to perform acousto-optic control.
Further, the action execution program module includes:
the sensor signal acquisition subprogram module is used for acquiring sensor signals according to the operation control instruction of the vehicle-mounted controller program module;
the steering wheel driver control subprogram module is used for controlling the steering wheel driver according to the operation control instruction of the vehicle-mounted controller program module;
and the sound and light control subprogram module is used for carrying out sound and light control according to the operation control instruction of the vehicle-mounted controller program module.
Further, the magnetic navigation tracking formula adopted by the magnetic navigation tracking algorithm in the algorithm control subroutine module is as follows:
Figure BDA0001674198480000021
wherein y is the direction speed of the steering wheel driver, x is the position offset of magnetic navigation, a is the quadratic term coefficient of the parabola, b is the first order term coefficient of the parabola, and c is the constant term.
Further, the sound and light control comprises flashing light control and preset music playing control.
The second technical scheme adopted by the invention is as follows:
the AGV trolley control method comprises the following steps:
the server scheduling program module performs AGVS scheduling on the AGV to generate an AGVS instruction, wherein the AGVS scheduling comprises AGV multi-vehicle cooperative scheduling;
the method comprises the following steps that an on-board controller program module carries out operation control on an AGV according to an AGVS scheduling instruction of a server scheduling program module to generate an operation control instruction, wherein the operation control comprises the step of obtaining the position offset and the steering wheel direction speed of magnetic navigation by adopting a parabola-based magnetic navigation track-finding algorithm;
and the action execution program module controls the AGV trolley to execute corresponding actions according to the operation control instruction.
Further, the step of the vehicle-mounted controller program module controlling the operation of the AGV according to the AGVS scheduling instruction of the server scheduling program module specifically includes:
the vehicle-mounted controller program module receives an AGVS scheduling instruction;
the vehicle-mounted controller program module calls a control algorithm of an algorithm control subprogram module according to the AGVS scheduling instruction to perform operation control on the AGV, and generates an operation control instruction, wherein the control algorithm of the algorithm control subprogram module comprises a laser navigation algorithm and a magnetic navigation tracking algorithm;
and the vehicle-mounted controller program module sends the operation control instruction to the action execution program module and acquires a sensor signal and a steering wheel action signal returned by the action execution program module.
Further, the step of controlling the AGV to execute the corresponding action by the action execution program module according to the operation control instruction specifically includes:
the action execution program module receives an operation control instruction;
the action execution program module acquires sensor signals according to the operation control instruction;
the action execution program module controls the steering wheel driver according to the operation control instruction;
the action execution program module performs sound and light control according to the operation control instruction;
the action execution program module returns the action signal of the steering wheel and the acquired sensor signal to the program module of the vehicle-mounted controller.
Further, the magnetic navigation tracking formula adopted by the magnetic navigation tracking algorithm is as follows:
Figure BDA0001674198480000031
wherein y is the direction speed of the steering wheel driver, x is the position offset of magnetic navigation, a is the quadratic term coefficient of the parabola, b is the first order term coefficient of the parabola, and c is the constant term.
Further, the sound and light control comprises flashing light control and preset music playing control.
The invention has the beneficial effects that: according to the AGV control system and method, the AGVS scheduling of the AGV is performed through the server scheduling program module, the AGV comprises AGV multi-vehicle cooperative scheduling, multiple AGV vehicles can be simultaneously and coordinately scheduled, and the scheduling efficiency is high; the on-vehicle controller program module adopts the magnetism navigation seeking algorithm based on the parabola to obtain the position offset and the steering wheel direction speed of magnetism navigation when carrying out operation control to the AGV dolly, has adopted the magnetism navigation seeking algorithm based on the parabola to replace the PID algorithm, and the parameter that needs to set or debug is less relatively, easily realizes, and the parameter is more stable, can also show with graphical interface's form in matlab, and is more directly perceived, and is convenient for debug the big turn of different angles.
Drawings
FIG. 1 is a block diagram of the program modules of an AGV control system according to the present invention;
FIG. 2 is a flowchart illustrating the steps of an AGV control method according to the present invention.
Detailed Description
The invention will be further explained and explained with reference to the drawings and the embodiments in the description.
Referring to fig. 1, the AGV cart control system of the present invention includes:
the server scheduling program module is used for carrying out AGVS scheduling on the AGV, wherein the AGVS scheduling comprises AGV multi-vehicle cooperative scheduling;
the system comprises a vehicle-mounted controller program module, a server scheduling program module and a control system, wherein the vehicle-mounted controller program module is used for controlling the operation of the AGV according to an AGVS scheduling instruction of the server scheduling program module, and the operation control comprises the step of obtaining the position offset and the steering wheel direction speed of magnetic navigation by adopting a parabola-based magnetic navigation tracking algorithm;
and the action execution program module is used for controlling the AGV to execute corresponding actions according to the operation control instruction of the vehicle-mounted controller program module, and the actions executed by the AGV comprise sensor signal acquisition, steering wheel driver control and acousto-optic control.
The server scheduling program module runs on an upper control system of the AGV, and has the main functions of distributing tasks, managing vehicles, managing traffic and the like to a plurality of single AGV trolleys in an AGV system (AGVS).
Wherein, the task management is similar to the process management of the computer operating system and provides an interpretation execution environment of the program module; providing scheduling operation service according to task priority and starting time; various operations such as start, stop, cancel, etc. are provided for the task.
The vehicle management is the core of AGV dispatching management, and it is according to the request of material handling task, distributes and dispatches AGV and carries out the task, according to the shortest principle of AGV dolly travel time, calculates the shortest walking route of AGV dolly to the walking process of control commander AGV dolly, in time assigns the loading and unloading goods and the command of charging.
And the traffic management provides measures for automatic avoidance of the AGV trolleys according to the physical size, the running state and the path condition of the AGV trolleys.
The vehicle-mounted controller program module runs on a single AGV trolley control system (namely a control system of each AGV trolley), and after receiving an AGVS scheduling instruction (namely an instruction of an upper AGV control system) of the server scheduling program module, the vehicle-mounted controller program module realizes the control functions of navigation control, path selection and the like of a single AGV trolley.
Navigation (Navigation): and measuring and calculating the position and the heading in the global coordinate by the single AGV trolley through a navigation device (such as a magnetic navigation sensor) arranged on the single AGV trolley.
Path selection (Searching): according to the instruction of the AGV upper control system, the single AGV trolley selects the path to be operated in advance through calculation, the result is reported to the AGV upper control system, and the AGV upper control system can operate or not and is uniformly allocated according to the positions of other AGV trolleys. The path of the single AGV trolley is designed according to the actual working conditions and consists of a plurality of segments. Each "segment" indicates the start point, the end point, and the travel speed and steering of the AGV car in that segment.
And the action execution program module runs on the action execution part of the single AGV and is used for carrying out operations such as sensor signal acquisition, steering wheel driver control, acousto-optic control and the like according to the operation control instruction of the vehicle-mounted controller program module. The sensor signals include magnetic navigation sensor signals, UWB position location signals, and the like.
Referring to fig. 1, further as a preferred embodiment, the onboard controller program module includes:
the local area network subprogram module is used for receiving the AGVS scheduling instruction of the server scheduling program module and returning the result of the AGV trolley action execution to the server scheduling program module;
the AGV control system comprises an algorithm control subprogram module, a control module and a control module, wherein the algorithm control subprogram module is used for providing a control algorithm of the AGV, and the control algorithm of the AGV comprises a laser navigation algorithm and a magnetic navigation tracking algorithm;
the communication subprogram module is used for communicating with the action execution program module, sending an operation control instruction to the action execution program module and acquiring a sensor signal and a steering wheel action signal returned by the action execution program module;
and the IO control subprogram module is used for sending an operation control instruction to the action execution program module through the IO port so as to perform acousto-optic control.
The laser navigation algorithm is used for positioning according to a laser head (such as a SICK laser sensor) and reflection of light on the roof of the AGV, and at least three navigation marks made of high-reflectivity materials are required to be fixed on the periphery of a work site; install laser scanner on the AGV dolly, then scan pulse laser emitter launch and by the laser that navigation mark all around reflects, utilize the triangulation location principle to calculate the position and the actual distance of AGV dolly relative navigation mark to calculate the coordinate of AGV automobile body among the world coordinate system, and then realize the guide to the AGV dolly. The laser navigation algorithm is accurate in positioning, but the cost is high.
And a magnetic navigation tracking algorithm is matched with a magnetic navigation sensor to obtain the position offset and steering wheel direction speed of the magnetic navigation by adopting a parabolic fitting test method, so that the AGV trolley can perform self-service tracking walking.
Referring to fig. 1, further as a preferred embodiment, the action execution program module includes:
the sensor signal acquisition subprogram module is used for acquiring sensor signals according to the operation control instruction of the vehicle-mounted controller program module;
the steering wheel driver control subprogram module is used for controlling the steering wheel driver according to the operation control instruction of the vehicle-mounted controller program module;
and the sound and light control subprogram module is used for carrying out sound and light control according to the operation control instruction of the vehicle-mounted controller program module.
Referring to fig. 1, further as a preferred embodiment, the magnetic navigation tracking formula adopted by the magnetic navigation tracking algorithm in the algorithm control subroutine module is as follows:
Figure BDA0001674198480000051
wherein y is the direction speed of the steering wheel driver, x is the position offset of magnetic navigation, a is the quadratic term coefficient of the parabola, b is the first order term coefficient of the parabola, and c is the constant term.
In the above formula, the positive and negative of a represent the opening direction of the parabola, the positive represents upward, the negative represents downward, the size of a reflects the opening size of the parabola, the larger the absolute value of a is, the smaller the opening is, the steeper the parabola is, the smaller the absolute value of a is, the larger the opening is, and the gentler the parabola is.
The larger the value of b, the steeper the parabola and, conversely, the flatter. The adjustment amplitude of b is small relative to the value of a.
Preferably, the magnetic navigation sensor of the present invention outputs a position offset value of-60 to +60, for example, the magnetic navigation sensor outputs 0, which indicates that the magnetic navigation is in the middle of the magnetic stripe at this time; the output of the magnetic navigation sensor is-30, which indicates that the magnetic navigation is at the position of-30 on the left side of the magnetic strip at the moment, and the value is smaller on the left; the magnetic navigation sensor output 30 indicates the position of the magnetic navigation on the right 30 of the magnetic stripe at that time, the value being larger the more the right.
And the steering control of the steering wheel is controlled by transmitting a steering value through a CANBUS of the steering wheel driver. The steering value takes 0 as a boundary, when the steering value is a positive value, the steering wheel turns left, and the absolute value of the steering value increases the left turning speed; when the steering value is a negative value, the steering wheel turns to the right, and the absolute value of the steering value is larger than the speed of turning to the right. The further away the magnetic navigation is from the center, the greater the speed of the right or left turn.
The magnetic navigation tracking algorithm of the embodiment is suitable for the case of combining the magnetic navigation and the steering wheel driver, and has the following advantages:
1. only three parameters of a, b and c are needed to be adjusted, and the debugging period is fast;
2. popular and easy to understand and easy to deform;
3. compared with the PID algorithm, the matlab can be used for displaying a graphical interface, so that the method is visual and has more stable parameters;
4. the large turning at various angles is convenient to debug.
Further as a preferred embodiment, the sound and light control includes a flashing light control and a preset music playing control.
Referring to fig. 2, the AGV control method of the present invention includes the following steps:
the server scheduling program module performs AGVS scheduling on the AGV to generate an AGVS instruction, wherein the AGVS scheduling comprises AGV multi-vehicle cooperative scheduling;
the method comprises the following steps that an on-board controller program module carries out operation control on an AGV according to an AGVS scheduling instruction of a server scheduling program module to generate an operation control instruction, wherein the operation control comprises the step of obtaining the position offset and the steering wheel direction speed of magnetic navigation by adopting a parabola-based magnetic navigation track-finding algorithm;
and the action execution program module controls the AGV to execute corresponding actions according to the operation control instruction, and the actions executed by the AGV comprise sensor signal acquisition, steering wheel driver control and acousto-optic control.
Further as a preferred embodiment, the step of the on-board controller program module controlling the operation of the AGV according to the AGVS scheduling instruction of the server scheduling program module specifically includes:
the vehicle-mounted controller program module receives an AGVS scheduling instruction;
the vehicle-mounted controller program module calls a control algorithm of an algorithm control subprogram module according to the AGVS scheduling instruction to perform operation control on the AGV, and generates an operation control instruction, wherein the control algorithm of the algorithm control subprogram module comprises a laser navigation algorithm and a magnetic navigation tracking algorithm;
and the vehicle-mounted controller program module sends the operation control instruction to the action execution program module and acquires a sensor signal and a steering wheel action signal returned by the action execution program module.
Further as a preferred embodiment, the step of controlling the AGV to execute the corresponding action according to the operation control command by the action execution program module specifically includes:
the action execution program module receives an operation control instruction;
the action execution program module acquires sensor signals according to the operation control instruction;
the action execution program module controls the steering wheel driver according to the operation control instruction;
the action execution program module performs sound and light control according to the operation control instruction;
the action execution program module returns the action signal of the steering wheel and the acquired sensor signal to the program module of the vehicle-mounted controller.
Further, as a preferred embodiment, the magnetic navigation tracking formula adopted by the magnetic navigation tracking algorithm is as follows:
Figure BDA0001674198480000071
wherein y is the direction speed of the steering wheel driver, x is the position offset of magnetic navigation, a is the quadratic term coefficient of the parabola, b is the first order term coefficient of the parabola, and c is the constant term.
Further as a preferred embodiment, the sound and light control includes a flashing light control and a preset music playing control.
In conclusion, the AGVS scheduling of the AGV by the server scheduling program module comprises AGV multi-vehicle cooperative scheduling, so that multiple AGV vehicles can be simultaneously and coordinately scheduled, and the scheduling efficiency is high; the on-vehicle controller program module adopts the magnetism navigation seeking algorithm based on the parabola to obtain the position offset and the steering wheel direction speed of magnetism navigation when carrying out operation control to the AGV dolly, has adopted the magnetism navigation seeking algorithm based on the parabola to replace the PID algorithm, and the parameter that needs to set or debug is less relatively, easily realizes, and the parameter is more stable, can also show with graphical interface's form in matlab, and is more directly perceived, and is convenient for debug the big turn of different angles. The scheme of the invention has a wide market application prospect in the field of logistics transportation equipment control.
While the preferred embodiments of the present invention have been illustrated and described, it will be understood by those skilled in the art that various changes in form and details may be made therein without departing from the spirit and scope of the invention as defined by the appended claims.

Claims (8)

  1. AGV dolly control system, its characterized in that: the method comprises the following steps:
    the server scheduling program module is used for carrying out AGVS scheduling on the AGV, wherein the AGVS scheduling comprises AGV multi-vehicle cooperative scheduling;
    the system comprises a vehicle-mounted controller program module, a server scheduling program module and a control system, wherein the vehicle-mounted controller program module is used for controlling the operation of the AGV according to an AGVS scheduling instruction of the server scheduling program module, and the operation control comprises the step of obtaining the position offset and the steering wheel direction speed of magnetic navigation by adopting a parabola-based magnetic navigation tracking algorithm;
    the action execution program module is used for controlling the AGV to execute corresponding actions according to the operation control instruction of the vehicle-mounted controller program module;
    the magnetic navigation tracking formula adopted by the magnetic navigation tracking algorithm is as follows:
    Figure FDA0003117911670000011
    wherein y is the direction speed of the steering wheel driver, x is the position offset of magnetic navigation, a is the quadratic term coefficient of a parabola, b is the first order term coefficient of the parabola, and c is a constant term;
    wherein the steering wheel driver is used for driving the steering wheel, and the control of the steering wheel is controlled by a steering value sent by CANBUS of the steering wheel driver.
  2. 2. The AGV cart control system of claim 1, further comprising: the on-board controller program module includes:
    the local area network subprogram module is used for receiving the AGVS scheduling instruction of the server scheduling program module and returning the result of the AGV trolley action execution to the server scheduling program module;
    the AGV control system comprises an algorithm control subprogram module, a control module and a control module, wherein the algorithm control subprogram module is used for providing a control algorithm of the AGV, and the control algorithm of the AGV comprises a laser navigation algorithm and a magnetic navigation tracking algorithm;
    the communication subprogram module is used for communicating with the action execution program module, sending an operation control instruction to the action execution program module and acquiring a sensor signal and a steering wheel action signal returned by the action execution program module;
    and the IO control subprogram module is used for sending an operation control instruction to the action execution program module through the IO port so as to perform acousto-optic control.
  3. 3. The AGV cart control system of claim 1, further comprising: the action execution program module includes:
    the sensor signal acquisition subprogram module is used for acquiring sensor signals according to the operation control instruction of the vehicle-mounted controller program module;
    the steering wheel driver control subprogram module is used for controlling the steering wheel driver according to the operation control instruction of the vehicle-mounted controller program module;
    and the sound and light control subprogram module is used for carrying out sound and light control according to the operation control instruction of the vehicle-mounted controller program module.
  4. 4. The AGV control system of claim 3, wherein: the sound and light control comprises flashing light control and preset music playing control.
  5. The AGV trolley control method is characterized by comprising the following steps: the method comprises the following steps:
    the server scheduling program module performs AGVS scheduling on the AGV to generate an AGVS instruction, wherein the AGVS scheduling comprises AGV multi-vehicle cooperative scheduling;
    the method comprises the following steps that an on-board controller program module carries out operation control on an AGV according to an AGVS scheduling instruction of a server scheduling program module to generate an operation control instruction, wherein the operation control comprises the step of obtaining the position offset and the steering wheel direction speed of magnetic navigation by adopting a parabola-based magnetic navigation track-finding algorithm;
    the action execution program module controls the AGV trolley to execute corresponding actions according to the operation control instruction;
    the magnetic navigation tracking formula adopted by the magnetic navigation tracking algorithm is as follows:
    Figure FDA0003117911670000021
    wherein y is the direction speed of the steering wheel driver, x is the position offset of magnetic navigation, a is the quadratic term coefficient of a parabola, b is the first order term coefficient of the parabola, and c is a constant term;
    wherein the steering wheel driver is used for driving the steering wheel, and the control of the steering wheel is controlled by a steering value sent by CANBUS of the steering wheel driver.
  6. 6. The AGV control method of claim 5, wherein: the step that the vehicle-mounted controller program module controls the AGV to run according to the AGVS scheduling instruction of the server scheduling program module specifically comprises the following steps:
    the vehicle-mounted controller program module receives an AGVS scheduling instruction;
    the vehicle-mounted controller program module calls a control algorithm of an algorithm control subprogram module according to the AGVS scheduling instruction to perform operation control on the AGV, and generates an operation control instruction, wherein the control algorithm of the algorithm control subprogram module comprises a laser navigation algorithm and a magnetic navigation tracking algorithm;
    and the vehicle-mounted controller program module sends the operation control instruction to the action execution program module and acquires a sensor signal and a steering wheel action signal returned by the action execution program module.
  7. 7. The AGV control method of claim 5, wherein: the step that the action execution program module controls the AGV trolley to execute corresponding actions according to the operation control instruction specifically comprises the following steps:
    the action execution program module receives an operation control instruction;
    the action execution program module acquires sensor signals according to the operation control instruction;
    the action execution program module controls the steering wheel driver according to the operation control instruction;
    the action execution program module performs sound and light control according to the operation control instruction;
    the action execution program module returns the action signal of the steering wheel and the acquired sensor signal to the program module of the vehicle-mounted controller.
  8. 8. The AGV control method of claim 7, wherein: the sound and light control comprises flashing light control and preset music playing control.
CN201810517951.4A 2018-05-25 2018-05-25 AGV trolley control system and method Expired - Fee Related CN108549391B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810517951.4A CN108549391B (en) 2018-05-25 2018-05-25 AGV trolley control system and method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810517951.4A CN108549391B (en) 2018-05-25 2018-05-25 AGV trolley control system and method

Publications (2)

Publication Number Publication Date
CN108549391A CN108549391A (en) 2018-09-18
CN108549391B true CN108549391B (en) 2021-11-19

Family

ID=63511229

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810517951.4A Expired - Fee Related CN108549391B (en) 2018-05-25 2018-05-25 AGV trolley control system and method

Country Status (1)

Country Link
CN (1) CN108549391B (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109407666A (en) * 2018-10-11 2019-03-01 智久(厦门)机器人科技有限公司上海分公司 A kind of control method of vehicle, device, equipment and storage medium
CN109279543B (en) * 2018-11-07 2020-10-30 上海大学 Forklift AGV magnetic guide rail tracking control system and method
CN109725616B (en) * 2018-12-29 2020-10-30 广州远联物流服务有限公司 Intelligent warehouse-based unmanned carrier scheduling method and device
CN111413988B (en) * 2020-04-10 2023-08-25 三一机器人科技有限公司 Multi-vehicle linkage method and multi-vehicle linkage system

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107065888A (en) * 2017-05-26 2017-08-18 金陵科技学院 One kind is based on magnetic navigation robot and navigation scheduling system and method
CN206470605U (en) * 2017-01-20 2017-09-05 武汉理工大学 A kind of automatical pilot transportation vehicle monitoring and dispatching system
CN107450571A (en) * 2017-09-30 2017-12-08 江西洪都航空工业集团有限责任公司 A kind of AGV dolly Laser navigation systems based on ROS
CN107744370A (en) * 2016-07-13 2018-03-02 艾罗伯特公司 Autonomous robot automatic docked and EMS and method
CN207198902U (en) * 2017-09-21 2018-04-06 四川中烟工业有限责任公司 A kind of automatic transportation task scheduling system based on AGV mobile platforms
CN107915169A (en) * 2017-12-15 2018-04-17 广东溢达纺织有限公司 Automatic transportation mechanism

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2506760B2 (en) * 1986-05-12 1996-06-12 松下電器産業株式会社 Robot controller
US6345217B1 (en) * 2000-03-31 2002-02-05 Rapistan Systems Advertising Corp. Automated guided vehicle (AGV) with bipolar magnet sensing
ATE301302T1 (en) * 2002-01-24 2005-08-15 Irobot Corp METHOD AND SYSTEM FOR ROBOT LOCATION AND WORKING AREA RESTRICTION
JP4169065B2 (en) * 2006-02-13 2008-10-22 株式会社デンソー Vehicle control device
JP4412329B2 (en) * 2007-01-31 2010-02-10 株式会社デンソーウェーブ Robot control apparatus and robot position command value correction method
CN102145808B (en) * 2011-01-27 2012-09-26 合肥工业大学 Industrial laser guidance AGV double-closed-loop control system and control method thereof
US11137490B2 (en) * 2014-09-16 2021-10-05 Teknologian Tutkimuskeskus Vtt Navigational aid with adaptive radar
CN104331080B (en) * 2014-11-21 2015-08-26 中国人民解放军国防科学技术大学 For the fixed point track path planing method of mobile robot
JPWO2016203550A1 (en) * 2015-06-16 2018-04-05 富士機械製造株式会社 Route data creation device and route data creation method
KR20170002051A (en) * 2015-06-29 2017-01-06 삼성전자주식회사 A method and an electronic device for one-hane user interface
JP6269735B2 (en) * 2015-11-25 2018-01-31 カシオ計算機株式会社 Flight apparatus, method, and program
CN105573315B (en) * 2015-12-01 2020-04-10 珞石(北京)科技有限公司 Geometric smoothing method for Cartesian space trajectory of industrial robot
CN106856493A (en) * 2015-12-08 2017-06-16 广东科达洁能股份有限公司 A kind of AGV cluster center management systems based on Web
JP2017122990A (en) * 2016-01-05 2017-07-13 株式会社リコー Travel device, travel control device, and travel control system
CN107452218B (en) * 2017-09-22 2020-04-03 西北工业大学 Intersection centralized scheduling method for multi-unmanned vehicle formation

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107744370A (en) * 2016-07-13 2018-03-02 艾罗伯特公司 Autonomous robot automatic docked and EMS and method
CN206470605U (en) * 2017-01-20 2017-09-05 武汉理工大学 A kind of automatical pilot transportation vehicle monitoring and dispatching system
CN107065888A (en) * 2017-05-26 2017-08-18 金陵科技学院 One kind is based on magnetic navigation robot and navigation scheduling system and method
CN207198902U (en) * 2017-09-21 2018-04-06 四川中烟工业有限责任公司 A kind of automatic transportation task scheduling system based on AGV mobile platforms
CN107450571A (en) * 2017-09-30 2017-12-08 江西洪都航空工业集团有限责任公司 A kind of AGV dolly Laser navigation systems based on ROS
CN107915169A (en) * 2017-12-15 2018-04-17 广东溢达纺织有限公司 Automatic transportation mechanism

Also Published As

Publication number Publication date
CN108549391A (en) 2018-09-18

Similar Documents

Publication Publication Date Title
CN108549391B (en) AGV trolley control system and method
US10875448B2 (en) Visually indicating vehicle caution regions
US8972095B2 (en) Automatic guided vehicle and method for drive control of the same
CN105045268B (en) A kind of AGV laser tape hybrid navigation system
CN107421518B (en) Automatic truck entering and exiting method of trackless navigation AGV
CN109403690A (en) Automotive vehicle carries method, system and the application with transfer
CN108873902A (en) A kind of long-range control method and device of unmanned mine vehicle
US20210279670A1 (en) Systems and methods for autonomous lineside parts delivery to an assembly line process
CN109445438B (en) Cruise control method and system of cruise device based on map sharing
CN113848910B (en) Navigation system, navigation control method and device, controller and AGV
CN103048996A (en) Automatic guided vehicle based on laser scanning distance meter, and system and navigation method of automatic guided vehicle
CN107522114B (en) Automatic change front and hang
JP7450271B2 (en) Conveyance system and conveyance control method
CN109144068A (en) The automatically controlled mode and control device of three-dimensional shift-forward type navigation switching AGV fork truck
CN205121338U (en) AGV navigation based on image recognition and wireless network
CN111620022A (en) Control system of special storage carrier
CN111152782A (en) Automatic parking control system and control method
CN204883363U (en) AGV transport robot navigation system that laser guidance map found
CN109508006A (en) A kind of automated driving system of the autocrane based on Beidou
JP7112803B1 (en) Transport system and transport control method
CN113341968A (en) Accurate parking system and method for multi-axis flat car
CN115877853B (en) Intelligent warehouse logistics path planning system and method
CN109947105A (en) A kind of speed regulating method and speed regulation device of automatic tractor
CN215494708U (en) Intelligent terrace marking robot
CN114265375A (en) System and method for AGV to access flat truck goods

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
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20211119